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Abstract 


This  report  describes  the  results  obtained  for  the  contract  EOARD  F61775-02-WE031, 
during  the  period  June  2002-May  2003.  The  research  was  performed  at  the  Univer¬ 
sity  of  Pisa,  Italy,  in  the  Department  of  Electrical  Systems  and  Automation,  with 
Prof.  Mario  Innocenti  as  principal  investigator.  The  personnel  involved  in  the  work 
included  also  Prof.  Andrea  Caiti,  Dr.  Lorenzo  Pollini,  and  Mr.  demetrio  Turra, 
respectively  associate  professor,  post-doctoral  fellow,  and  Ph.D.  student  in  the  same 
department.  Dr.  Fabrizio  Giulietti,  currently  post-doctoral  fellow  at  the  University 
of  Bologna  (Forli  campus)  participated  to  the  effort  primarily  on  the  aspects  related 
to  formation  dynamics  and  control.  The  contractor’s  technical  monitor  was  Dr.  Neal 
Glassman  from  EOARD,  and  the  contact  point  for  the  actual  detailed  aspects  of  the 
work  was  Mr.  Fred  Davis  (AFRL/MNA).  The  report  contains  two  parts:  Part  1  de¬ 
scribes  the  results  obtained,  and  methodologies  developed,  for  dynamics  and  control 
of  unmanned  air  vehicles  flying  in  a  formation.  The  second  part  describes  a  fuzzy-set 
approach  to  the  guidance  and  control  management  of  vehicles,  in  order  to  establish 
conditions  for  succesfull  terget  intercept.  From  the  research  activity  performed  within 
the  present  effort,  the  following  publications  were  submitted/accepted/published: 

•  Innocenti  M.,  Pollini  L.,  Turra  D.,  “A  Fuzzy  Approach  to  the  Guidance  of  Un¬ 
manned  Air  Vehicles  Tracking  moving  Targets”,  submitted  to  the  IEEE  Tran- 
scactions  on  Control  Systems  Technology,  June  2003. 

•  Pollini,  L.,  Giulietti,  F.,  Innocenti,  M.,  “Dynamic  and  Control  Issues  of  Form¬ 
ation  Flight”,  Aerospace  Science  and  Technology,  submitted  June,  2002. 


•  Innocenti  M.,  Pollini  L.,  Turra  D.,  “A  Guidance  System  for  Unmanned  Air 
Vehicles  based  on  fuzzy  Sets  and  fixed  Waypoints”,  submitted  to  the  AIAA 
Journal  of  Guidance,  Control,  and  Dynamics,  May  2003  (accepted,  in  press). 

•  Innocenti  M.,  Pollini  L.,  Marullo  A.,  “Gain-Scheduling  Stability  Issues  using 
Differential  Inclusion  and  Fuzzy  Systems”,  submitted  to  the  AIAA  Journal  of 
Guidance,  Control,  and  Dynamics,  May  2003.  (accepted,  in  press). 

•  Innocenti  M.,  Pollini  L,  Giulietti  F.,  “Management  of  Communication  Failures 
in  Formation  Flight”,  submitted  to  the  AIAA  Journal  of  Aerospace  Computing, 
Information,  and  Communication,  Vol.  1,  No.  1,  pp.19-35,  January  2004. 

•  Turra,  D.,  Pollini,  L.,  Innocenti,  M.,  “Moving  Waypoint-based  Fuzzy  Guidance 
for  Unmanned  Aircraft”,  AIAA  Guidance,  Navigation,  and  Control  Conference, 
GNC03,  Austin,  TX,  August  2003. 

•  Pollini,  L.,  Mati,  R,  Innocenti,  M.,  G.Campa,  G.,  M.Napolitano,  M.,  “  A  syn¬ 
thetic  environment  for  simulation  of  vision-based  formation  flight,” ,  AIAA  Mod¬ 
eling  and  Simulation  Technologies,  MST2003,  Austin,  TX,  August  2003. 

•  Pollini,  L.,Baralli,  F.,  Innocenti,  M.,  "Waypoint-based  Fuzzy  Guidance  for  Un¬ 
manned  Aircraft  -  A  New  Approach",  AIAA  Guidance,  Navigation  and  Control 
Conference,  Monterey,  California,  August  2002. 

•  Giulietti,  F.,  Napolitano,  M.,  Capetta,  R.,  Innocenti,  M.,  “Detailed  Modeling  of 
Multiple  Aircraft  within  close  Formation”,  AIAA  Atmospheric  Flight  Mechanics 
Conference,  Monterey,  California,  August  2002. 
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Part  I 

Dynamics  and  Control  of 
Formation  Fligh 


Chapter  1 


Formation  Flight  Dynamic 
Modelling 


1.1  Introduction 

The  quest  for  increased  performance  in  unmanned  aerospace  vehicles  yields  new  aero¬ 
dynamic  configurations  mainly  tailless  (stealth  capabilities),  with  high  angles  of  at¬ 
tack  for  post-stall  aerodynamic  regimes  (maneuverability),  including  thrust  vectoring 
capabilities  (agility,  performance,  and  survivability  following  battle  damage).  In  ad¬ 
diction,  the  use  of  multi-aircraft  formations  is  becoming  of  interest  for  a  variety  of 
missions.  The  present  chapter  is  related  to  the  latter  aspect,  that  is  formation  flying 
of  Unmanned  Air  Vehicles  (UAVs).  Until  recently,  UAVs  have  been  primarily  used 
as  test  bed.  For  instance  they  were  used  to  test  flight  envelope  expansion  and  flight 
control  systems  for  the  manned  aircraft  or  as  a  target  for  weapon  systems.  Over  the 
last  ten  years,  UAVs  have  been  thought  as  operational  airborne  platforms  in  their 
own  rights,  and  have  received  considerable  attention  especially  in  military  applica- 
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tions.  Today  we  foresee  with  new  aerospace  scenarios,  where  UAVs  can  take  many 
roles  previously  performed  by  manned  aircraft,  as  well  as  new  tasks  that  are  more 
suited  to  unmanned  vehicles,  as  surveillance,  reconnaissance  and  rescue  in  hostile 
environment. 

The  operational  potential  of  UAVs  could  strongly  improved  by  making  them  flying 
within  a  close  formation.  The  first  advantage  comes  from  aerodynamic  effects.  It  is 
well  known  in  fact  that  aircraft  with  large  aspect  ratio  wings  have  better  overall 
aerodynamic  efficiency  because  of  reduction  in  drag  for  a  given  lift.  However,  large 
aspect  ratio  implies  large  wingspan  for  a  given  area,  this  means  that  the  resulting 
structure  will  be  unreasonably  flexible  and  fragile  for  lightweight  design  .  A  similar 
improvement  in  global  efficiency  can  be  achieved  by  flying  multiple  aircraft  in  close 
formation.  In  an  idealized  case  of  n  identical  aircraft,  each  with  the  aspect  ratio  AR, 
flying  in  tip  to  tip  formation,  the  effect  would  be  that  of  a  single  aircraft  with  n  x  AR 
aspect  ratio.  The  aerodynamic  benefits  are  due  to  favorable  wake-vortex  encounters. 
Wind  tunnel  tests  and  analytical  studies  have  shown  that  the  benefits  increase  as 
additional  aircraft  are  added  to  the  formation.  Moreover,  from  an  operational  point 
of  view,  many  aircraft  involved  in  a  mission  can  be  better  managed  if  they  fly  in  a 
formation,  rather  than  in  an  undefined  structure. 

The  first,  important  challenge  in  the  study  of  formation  flight  is  represented  by 
the  complexity  of  the  aerodynamic  coupling.  The  mathematical  modeling  of  the  aero¬ 
dynamic  interference  between  different  aircraft  in  a  formation  was  first  approached 
by  Bloy  and  others  [Bloy,  A.  W.  and  Jouma’a,  M.,  1995],  [Bloy,  A.  W.  et  al,  1993]. 

They  considered  the  problem  of  aerodynamic  interference  on  lateral  directional  stabil¬ 
ity  during  air-to-air  refuelling  maneuvers.  In  Reference  [Myatt,  J.  H.  and  Blake,  W.,  1999], 
Myatt  and  Blake  proposed  an  aerodynamic  database  with  experimental  data  for  the 
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follower  aircraft  in  a  two-vehicle  formation.  In  a  more  recent  work,  Gingras  and  co¬ 
workers  [Gingras,  D.,  1999],  [Gingras,  D.  and  Player,  J.,  2001],  proposed  wind  tunnel 
testing  to  acquire  data  for  close  vehicles  simulation,  while  Nelson  and  Jumper  used 
the  Horse-shoe  Vortex  theory  to  discuss  the  response  of  an  airplane  following  an 
encounter  with  the  trailing  vortex  wake  by  another  airplane,  [Nelson,  R.  C.,  2001]. 

The  problem  of  aerodynamic  interference  in  a  close  formation  flight  was  fur¬ 
ther  described  by  Blake,  D’Azzo  and  Multhopp,  with  a  Leader /Wingman  structure 
[Proud.  A.  W.  et  al,  1999],  [Blake,  W.  and  Multhopp,  D.,  1998].  The  Leader  gener¬ 
ates  vortices  behind  its  wing.  Such  vortices  exert  actions  on  the  Wingman  lifting 
surfaces.  In  their  approach,  the  Leader’s  wake  is  modeled  via  Horse-shoe  Vortex  the¬ 
ory  [Houghton,  E.L.  and  Brock,  A.E.,  1970],  and  the  drag  reduction,  sideslip  force 
and  induced  angle  of  attack  are  introduced  in  the  Wingman  dynamics  through  addi¬ 
tional  stability  derivatives  leading  to  a  mathematical  aircraft  model  for  a  formation 
flight. 

Close  formation  flight  control,  intended  as  a  guidance,  navigation  and  control 
problem,  was  originally  studied  for  a  classic  leader /wingman  configuration.  An  air¬ 
craft  (Leader)  is  selected  to  direct  the  formation,  following  a  prescribed  path,  and 
all  the  other  airplanes  (Wingmen)  are  expected  to  maintain  a  fixed  relative  distance 
with  respect  to  the  lead  airplane,  in  order  for  the  formation  to  maintain  a  desired 
geometrical  shape.  D’Azzo  and  co-workers  analyzed  the  kinematic  coupling  effect  of 
the  two- aircraft  Leader /Wingman  configuration,  and  introduced  a  proportional  integ¬ 
ral  (PI)  controller  for  formation  control  [Buzogany,  L.  E.  et  al.,  1993].  The  concept 
of  decentralized  control  for  UAVs  in  formation  flight  was  first  introduced  by  Wolfe, 
Chichka,  and  Speyer  [Chichka,  D.  and  Speyer,  J.,  1996].  The  advantages  of  using  de¬ 
centralized  controllers  are  clear,  especially  for  a  large  size  UAVs  formation,  where 
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a  full  state  feedback  solution  for  the  problem  could  be  quite  unfeasible  due  to  the 
very  high  number  of  states.  In  addition,  a  decentralized  control  approach  would 
provide  more  flexibility  for  a  varying  number  of  UAVs  in  the  formation.  Later  work 
by  Chichka,  Speyer  [Chichka,  D.  and  Speyer,  J.,  1996],  Chichka,  Speyer,  and  oth¬ 
ers  [D.  F.  Chichka  et  al,  1999]  focused  on  a  peak-seeking  control  approach  for  close 
formation  flight,  where  the  overall  formation  control  was  approached  as  an  optimal 
control  problem  with  the  objective  of  minimizing  drag.  A  fairly  intensive  and  in¬ 
clusive  study  on  formation  flight  control  -  with  the  use  of  a  PI  control  scheme  - 
was  presented  by  Proud,  Pachter,  and  D’Azzo  for  a  2-D  formulation  of  the  problem 
[M.  Pachter  and  J.L.  Dargan,  1994],  and  then  recently  exteded  to  a  3-D  formation 
dynamics  problem  [Proud.  A.  W.  et  al,  1999],  [M.  Pachter  et  al.,  2001].  Within  the 
area  of  formation  control,  adaptive  control  approaches  were  recently  presented  by 
Schumacher  and  Kumar  [Schumacher  and  Kumar,  2000].  This  adaptive  scheme  fea¬ 
tured  an  optimal  LQR  design  for  the  outer  loop  and  a  Dynamic  Inversion  design  for 
the  inner  loop.  In  reference  [F.  Giulietti  et  al,  2000],  two  different  Leader- Wingman 
structures  were  developed.  In  Leader- Mode,  each  Wingman  takes  the  trajectory  refer¬ 
ence  from  the  Leader  of  formation  while  in  Front-Mode  each  aircraft  takes  its  reference 
from  the  preceding  one. 

The  chapter  is  organized  as  follows.  Section  2  describes  aerodynamic  modeling 
issues,  sections  3  and  4  describe  the  formation  modeling,  and  the  three  dimensional 
code  used  for  aerodynamic  interference  calculation  is  presented.  Given  a  lifting  sur¬ 
face  system,  the  proposed  technique  permits  the  calculation  of  induced  velocities,  and 
the  forces  due  to  coupling  effects  between  aerodynamic  surfaces.  Thus,  the  above  res¬ 
ults  are  used  to  obtain  the  dynamic  model  of  an  aircraft  flying  within  a  formation. 
Moreover  the  kinematic  equations  of  the  relative  distance  between  aircraft  are  de¬ 
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veloped.  Section  5  presents  a  different  approach  to  formation  flight.  In  the  proposed 
strategy,  each  aircraft  does  not  refer  to  the  preceding  one  or  to  the  formation  leader, 
but  keeps  its  position  with  respect  to  an  imaginary  point  in  the  formation  whose 
dynamics  depend  on  all  the  aircraft  positions.  The  approach  is  based  on  the  appar¬ 
ent  behavior  of  some  migrational  birds,  that  during  a  migrational  flight  ’wait’  for 
the  those  birds  which  have  changed  the  original  geometry  of  the  formation  by  flying 
in  a  different  path.  The  formation  controller  is  constituted  by  two  components:  a 
trajectory  controller,  which  provides  tracking  of  a  prescribed  path,  and  a  position 
controller  which  permits  formation  geometry  keeping.  These  control  laws  are  mixed 
by  a  parameter  that  depends  on  the  position  error.  Simulations  showing  the  applic¬ 
ation  of  the  outlined  control  laws  are  presented,  including  a  comparison  between  the 
classical  Leader /Wingman  structure  and  the  proposed  strategy. 

1.2  Aerodynamic  Modeling 

This  section  describes  the  method  used  to  calculate  the  aerodynamic  coupling  effects 
introduced  by  close  formation  flight  on  each  aircraft  within  the  formation. 

The  single  Horse-shoe  Vortex  technique  consists  in  replacing  the  whole  lifting 
surface  by  a  single  vortex  made  with  two  free  segments  and  one  wing-fixed  segment. 
Such  model  is  simple  and  introduces  minor  modifications  to  the  dynamics  equations. 
However,  by  modeling  a  close  formation  by  the  single  Horse-Shoe  Vortex  theory,  only 
one  aircraft  is  affected  by  the  wake  efforts  and  the  effect  of  the  wake  along  the  x-axis 
is  not  modeled  in  order  to  obtain  a  close  analytical  solution.  This  may  cause  the 
results  not  to  be  very  accurate  and  complete.  In  fact,  in  a  formation  flight  problem, 
the  mathematical  modeling  for  all  the  aircraft  involved  in  the  formation  is  a  critical 
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issue,  especially  since  the  experimental  data  from  wind  tunnel  tests  may  be  too  costly 
in  case  of  an  increasing  number  of  vehicles. 

In  this  paper,  a  different  3-D  approach  based  on  a  wing-distributed  Horse-shoe 
vortex  system,  is  used.  Given  a  system  of  lifting  surfaces,  this  technique  features 
the  calculation  of  induced  velocities  as  well  as  the  forces  and  moments  due  to  the 
coupling  effects  between  all  the  aerodynamics  surfaces.  The  proposed  methodology 
has  been  coded  within  WakeCAD,  a  Matlab  detailed  code  designed  for  formation 
flight  modeling  issues  [Capetta,  R.  et  ai,  2001].  Within  the  approach,  wings  are  not 
modeled  with  a  single  Horse-shoe  Vortex;  instead  all  the  lifting  surfaces  are  modeled 
and  they  are  represented  by  a  ’vortex  system’  whose  dimensions  can  be  set  on  the 
base  of  the  required  accuracy.  Furthermore,  the  induced  velocities  relative  to  all  lifting 
surfaces  are  calculated.  WakeCAD  outputs  are  induced  velocities  lift  distributions, 
forces  coefficients  as  well  as  the  entire  set  of  stability  and  control  derivatives. 

1.2.1  The  Distributed  Horse- Shoe  Vortex  Technique 

The  first  step  consists  in  defining  the  lifting  surfaces.  Only  single  tapered  wings  are 
considered  within  this  effort.  To  define  each  lifting  surface,  the  following  vector  of 
geometrical  and  aerodynamic  parameters  of  the  surface  profile  is  introduced: 

Ftp  Sfi  A  a  Cr  Ct  C X,a  Cm0  C^oo  j  (l*^) 

where  5h,  A,  and  a  are  the  dihedral,  swept  and  twist  angle  of  the  lifting  surface 
respectively,  cr  and  Cj  are  the  root  and  tip  geometric  chord,  while  CLa,  Cmo  and  ax  are 
lift  and  moment  derivatives  and  the  angle  of  attack  of  the  root  profile.  Intermediate 
profiles  parameters  are  calculated  by  a  linear  interpolation  from  the  preceding  ones. 

Once  a  number  s  of  lifting  surfaces  has  been  defined,  each  surface  is  modeled 
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through  a  straight  line,  also  known  as  lifting  line,  passing  through  the  aerodynamic 
center  of  the  local  profile.  The  aerodynamic  center  of  the  single  profile  is  approx¬ 
imately  set  at  26%  of  the  geometric  chord.  Let  us  now  consider  the  r  —  th  lifting 
surface.  First  the  two  halves  of  its  lifting  line  are  divided  in  nr/2  segments.  Then 
a  vortex  system,  composed  by  a  number  nr  of  horse-shoe  vortices,  is  distributed  on 
each  lifting  line.  Each  horse-shoe  vortex  is  modeled  with  a  wing-fixed  portion  and 
two  free  portions  that  extend  to  infinity.  Thus  the  two  following  subsets  of  points  are 
introduced: 

Pr  =  {  Pfcr  <E  R3;  fc  =  l...nr  +  l}  (1.2) 

and 

mr  =  {  mkr  6  R3;  k  =  1 . . .  nr  }  (1.3) 

The  first  subset,  Pr,  contains  the  points  where  the  free  portions  of  each  horse-shoe 
vortex  leaves  the  lifting  line.  For  example,  given  the  kr  —  th  vortex,  the  points  Pfer  and 
Pfcr+1  are  the  points  where  the  free  portions  of  this  vortex  leave  the  lifting  line.  The 
second  subset,  mr,  contains  the  points  where  the  induced  velocity  is  evaluated.  They 
are  the  middle  points  of  the  wing-fixed  portions  of  each  horse-shoe  vortex.  The  point 
mkr  is  the  middle  point  of  the  segment  PkrPkr+ 1-  Figure  1.1  shows,  as  an  example, 
the  generic  r  —  th  lifting  surface  with  the  vortex  system  along  with  the  points  Pkr 
and  mkr . 


1.2.2  Induced  Velocity  Calculation 

Once  the  lifting  surfaces  have  been  defined,  in  terms  of  lifting  line  and  vortex  sys¬ 
tems,  the  induced  velocity,  and  the  strength  of  the  vortices  may  be  evaluated.  The 
aerodynamic  interference  is  calculated  by  locally  using  the  fluid  dynamic  analogue  of 
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Figure  1.1:  Lifting  Surface  and  Vortex  System 


the  Biot-Savart  law  from  electromagnetics.  Such  law  is  applied  both  to  the  wing-fixed 
portion  and  to  the  free  portions  of  each  vortex. 

Consider  the  generic  vortex  segment  defined  between  the  points  P\,  I’z  •  The 
velocity  induced  by  this  vortex  segment  on  the  point  m  is  orthogonal  to  the  plane 
containing  the  vortex  segment  and  the  vector  Pjra,  as  shown  in  Figure  1.2.  The 
induced  velocity  direction  is  then  given  by: 


di2  xPjm 
U(dl2'm)  =  |  d12  x  Pxm  | 


(1.4) 


where  the  vector  dV2  is  the  vector  associated  with  the  vortex  segment.  Let  us  now 
introduce  the  induction  function  4 >(d12,m)  for  the  given  vortex  segment,  defined  as  the 
induced  velocity  per  unit  value  of  vortex  strength.  Its  expression,  according  to  the 
Biot-Savart  law,  is  given  by: 


where  h(d  12>m) 


$Wm)  =  T~T""“ -  [c°S  P[dl2lm)  +  C0S^(dl2,m)]  '  ^(d12,m)  (1-5) 

*±71  fl(di2,7n) 

is  the  distance  between  the  point  m  and  the  segment  d12,  while 


Figure  1.2:  Induced  Velocity  Direction 
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Figure  1.3:  Induced  Velocity  Modulus  Calculation 


Finally,  the  quantities  cos  f3L  and  cos  P"dl2^m)  are  computed  as: 


COS  Pu 


b(di2,m) 

I  P\m  I 


(1.10) 


dio  I  — 61 


'(<212, m) 


(dl2,m) 


(1.11) 


If  the  vortex  segment  extends  to  infinity,  that  is  Pi  or  P2  go  to  infinity,  the  values  of 
^(rfl2,m)  or  (3"di2  tend  to  zero  respectively. 

Now  the  induction  function  is  defined,  the  induced  velocity  vector  can  be  intro¬ 
duced  as  follows.  Consider  two  generic  aerodynamic  surfaces,  and  let  Ffcr  be  the 
strength  of  the  k  —  th  horse-shoes  vortex  belonging  to  the  r  —  th  surface.  The  velocity 
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induced  by  such  vortex  on  the  point  vrtj  is  given  by: 


=  r‘-  •  %.  ],) 


(1.12) 


It  is  important  to  notice  that  the  induction  function  $(kr,jg),  is  the  sum  of  the  con¬ 
tributions  of  the  wing-fixed  vortex  segment  and  two  free  vortex  segment.  Then  the 
following  equation  is  imposed  on  the  point  rrij  : 


pTj'Voo  =  ^pVlCLajq  (ajq  -  a\)  c. 


'3q 


(1.13) 


Where  cPjq  is  the  induced  angle  of  attack  on  the  point  inJq .  It  is  given  by: 

VJ 


"*■  K 


-i  o  ivr 

°°  r=l  k=  1 


3g) 


(1.14) 


The  substitution  of  dj  in  equation  (1.13)  leads  to: 


1  (  1  5  nr  \ 

=  -„VlCLajq  K  -  XT  E 


(1.15) 


where  $z(kr,jq)  ^  fhe  component  along  the  z-axis  of  the  induction  function.  The 
previous  equation  can  be  rewritten  removing  the  dependency  from  the  airspeed 
by  introducing  a  new  variable: 

(1.16) 


r* 


Thus  equation  (1.15)  becomes: 


7* 


2  CJjOLJq  Cjq 


=  -  Y  Y^ 


z  {kr,jq) 


(1.17) 

r=l  fc=l 

Furthermore,  by  imposing  the  previous  equation  (1.17)  on  each  point  rrijq  Emq(q  — 
1 . . .  s),  a  linear  system  in  the  standard  form  is  obtained. 


Ax  =  B 


(1.18) 
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In  this  case  matrix  A  6  R(NxN\  where  N  is  the  dimension  of  the  whole  vortex  system, 
is  given  by: 

Ui  •  •  •  Au] 


A  = 


(1.19) 


•  •  *  ^SSJ 

Partition  Arq  G  contains  the  induction  coefficients  in  the  points  belonging 

to  mq:  due  to  the  vortices  of  the  r  —  th  lifting  surface.  Such  coefficient  are  given  by: 


Arq{k ,  j)  \ 


r  +  q 


[  1/2  CLajq  cjq  r  =  q,  k  —  j 
The  matrix  B  G  is  given  by: 


(1.20) 


(1.21) 


where  the  partition  Bq  G  r("«x1)  contains  angle  of  attack  values  in  the  points  be- 
longing  to  mq: 


B,(j)  =  a„ 


(1.22) 


The  solution  of  the  linear  system  provides  the  strength  of  the  vortex  system. 


1.2.3  Force  and  Moment  Coefficients 

Once  the  value  of  the  magnitude  of  the  vortex  system  is  known,  aerodynamic  forces, 
moments  and  coefficients  can  be  finally  computed.  Consider  the  point  m]q ;  the  force 
acting  on  rrijq  is  directed  along  a  direction  normal  to  the  velocity  V .  Its  magnitude 
is  given  by: 

I  Fjq  1=  pvrjq  =  PV2ljq  =  \pV2CFjqcjq  (1.23) 
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The  velocity  vector  V  is  given  by  the  sum  of  asymptotic  velocity  and  induced 
velocity  V*.  From  equation  (1.23): 

I  4  I- <**<*.-  2  %,  (1-24) 


where  Fjq  is  defined  as  the  force  for  unit  of  dynamic  pressure.  By  dividing  the  total 
force  by  the  quantity  Sqj  the  aerodynamic  coefficients  of  the  q  —  th  lifting  surface  are 
obtained  using: 


tc\ 


Cf„  — 


yyq 


2  Fn 


(1.25) 


\c-'/ 


Similarly  the  aerodynamic  moment  coefficients,  around  point  rrijq  can  be  obtained  as 
follows.  Consider  the  moment  for  unit  of  dynamic  pressure: 


Ma  =  C 


±3q 


Mo 


3q  3q 


+  QPjq  X  Fjg 


(1.26) 


where  CM0jq  is  a  vector  containing  the  moment  coefficients  of  the  profile  in  the  point 
mj9,  and  QPjq  is  the  distance  vector  between  such  point  and  a  reference  point  Q.  The 
total  moment  acting  on  the  q  —  th  lifting  surface  is  then  given  by: 


3= 1 


(1.27) 


and  thus  the  coefficients  are  expressed  by: 


Cm„  = 


t  Cj  ^ 

Cm 

\c 


2  M, 
S,l' 


(1.28) 


where  l*  is  the  mean  aerodynamic  cord  in  case  of  pitching  moment  and  the  wing 
span  in  case  of  rolling  and  yawing  moment.  Finally,  force  and  moment  coefficients 
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1.3  Formation  Dynamics 

This  section  describes  the  mathematical  model  of  an  aircraft  flying  within  a  formation. 
The  main  difference  with  the  model  of  an  ’isolated’  aircraft  consists  in  the  value  of  the 
aerodynamic  coefficients.  The  modeling  procedures  outlined  in  the  previous  section 
are  introduced.  Once  the  mathematical  model  is  developed,  the  kinematic  equations 
describing  the  relative  distances  between  the  aircraft  are  derived.  These  equations 
are  the  basis  of  formation  control  system  design. 


1.3.1  Modified  Equations  of  Motion 

The  aerodynamic  force  and  moment  coefficients,  evaluated  in  the  previous  section, 
can  be  directly  introduced  in  the  flight  dynamic  equations.  However,  it  is  useful  to 
split  the  aerodynamic  coefficients  according  two  different  contributions: 


The  first  term  of  the  right  hand  side  is  the  aerodynamic  coefficient  vector  in  case  of 
’isolated’  flight,  while  the  second  is  due  to  the  contributions  associated  with  formation 
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flying.  The  terms  Cp /  and  Cm  j,  are  functions  of  the  relative  distances  between  the 
aircraft.  The  use  of  equation  (1.31)  allows  to  separate  the  wake  effects  in  the  dynamics 
model.  This  can  be  useful  within  the  design  of  the  control  laws,  since  the  wake  effects 
can  be  seen  as  disturbances  to  be  rejected  by  the  control  system. 

For  the  purposes  of  the  present  effort  the  three  degrees-of-freedom,  non-linear 
mathematical  model  is  used: 


tV  (T-D) 

V  = - g  sin  7 


m 


7 


X  = 


—  (n  cos  <j)  —  cos  7) 
g  n  sin  <j> 


(1.32) 

(1.33) 

VcoS1  (L34) 

The  state  variables  describing  the  aircraft  dynamics  are  the  airspeed  V,  the  flight 
path  angle  7  and  the  heading  angle  7,  while  T,  n  and  (f),  are  thrust,  load  factor  and 
bank  angle  and  they  are  the  input  variables;  D  is  the  aerodynamic  drag  and  m  the 
aircraft  mass.  According  to  (1.31),  the  system  can  be  rewritten  introducing  changes 
in  lift,  induced  drag  and  side  force.  This  leads  to: 


T>  T-D  .  A  Di 

V  = - gsm'y - 


m 


m 


7  = 


V 


/  AL ' 

In  -I - )  cos <p  —  cos 7 

mg' 


(1.35) 

(1.36) 


..  _  S(n+  ^)sin0  A Y 
X~  V  cos  7  +  mV 

Thus  the  general  expression  of  the  equation  of  motion  can  be  rewritten  as: 

X/  =  X.  +  ipl/2S(A,.CF,) 


(1.37) 


(1.38) 


where  X  =  ( V,  7,  7  )T.  The  subscripts  ’/’  an<f  V  indicate  ’formation’  and  ’isolated’ 
flight  respectively.  Changes  in  the  equations  of  motion  are  introduced  by  the  term 
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(A f  ■  Cpf),  where  the  matrix  A/  €  M(3x3^  is  defined  by: 


ty 


\ 


1/m  0  0 

Af  =  |  0  cos  4>/mV  0  (1.39) 

^  0  smcj)/(mV COS7)  1/mV j 

The  coefficients  contained  in  Cpj  are  functions  of  the  system  state  vector  and  the 
relative  position  with  respect  to  the  other  aircraft  in  the  formation. 


1.3.2  Formation  Kinematics 

To  maintain  the  formation  geometry,  each  aircraft  must  keep  its  prescribed  distance 
from  a  reference.  Such  reference  may  be  the  Leader  of  the  formation  or  a  neighborhood 
aircraft  or  an  imaginary  point  within  the  formation.  To  calculate  the  relative  distance 
of  the  i  —  th  aircraft  from  its  reference  r,  three  reference  frames  are  introduced:  an 
inertial,  Earth-Fixed  frame  F©  and  two  kinematic  frames  F^  and  Ffcr,  with  the  origin 
on  the  i—th  aircraft  and  on  reference  r  respectively.  The  relationship  between  position 
derivatives,  referred  to  the  inertial  frame  is  given  by: 

P°  =  p?  +  Vg.  +  n°  x  R°r  (1.40) 

where  P(.)  is  the  position  vector,  Vi<r  is  the  linear  velocity  of  the  frame  ¥ki  with 
respect  the  frame  Ffcj,  SI*  is  the  angular  velocity  of  the  frame  F and  Ri  r  is  the 
distance  vector  between  the  two  kinematic  frames.  By  referring  to  the  frame  F^,  the 
previous  equation  becomes: 

v*r  -  V)  +  vjiP  +  ni  x  Rl  (1.41) 
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where  V*  =  [dx,  dy ,  cb]T,  Oj  =  [0,  7*,  X;]T,  and  R\r  =  [dx,  dy,  d z]T  while  the 
vector  Vj.  is  given  by: 


Vr  COS  7e  COS  Je 

vt=  K  cos  7e  sin  Xe  (1-42) 

-yrsin7e 

where  7e  =  7r  ~  7*  and  Xe  =  Xr  —  Xi-  Thus  the  complete  dynamic  of  the  distance 
between  the  i  —  th  aircraft  and  its  reference  is  given  by: 


dx 

Vr  COS  7e  COS  7e 

Vi 

7 idy  -  Xidz 

dy 

= 

Vr  cos  7e  sin  ye 

- 

0 

+ 

-Xidx 

dz 

—Vr  sin7e 

0 

7 %dx 

The  previous  method  for  relative  distances  calculation  is  typically  used  when  aircraft 
within  the  formation  exchange  trajectory  information,  particularly  airspeed,  flight 
path  angle,  and  heading  angle. 

If  the  trajectory  information  are  not  available,  and  the  if  aircraft  knows  the  ab¬ 
solute  position  (e.g.  by  GPS)  only,  the  relative  distances  between  aircraft  could  be 
computed  first  referred  to  the  inertial  frame  and  then  rotated  to  the  kinematic  frame 
of  each  aircraft.  The  distance  between  the  i  —  th  aircraft  from  its  reference. r,  referred 
to  the  inertial  frame  is  defined  as: 


d°  =  Pr-  Pi  (1.44) 

where  Pi  and  Pr  are  the  position  of  the  i  —  th  aircraft  and  its  reference  in  the  Earth- 
fixed  frame  Fo-  In  formation  flying  it  is  necessary  to  rotate  the  distance  between 
aircraft  and  their  reference  in  a  local  frame  which  has  its  origin  in  the  center  of  mass 
of  each  aircraft.  The  transformation  of  the  inertial,  Earth-fixed  frame  Fq  to  the 
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Kinematic  frame  can  be  obtained  introducing  the  following  rotation  matrix:  1 


Toh  = 


(  cos  Xx  cos  7i  sin  sin  7^  cos  Xi  cos  (pi  sin  7;  cos  Xi  ^ 
—  sin  Xi  cos  (f>i  +  sin  (pi  sin  Xi 

sin  Xi  cos  7^  sin  7*  sin  (pi  sin  Xi  sin  7 *  cos  (pi  sin  Xi 
+  cos  Xi  cos  (pi  —  sin  (pi  cos  Xi 


(1.45) 


y  —  sin  7,  cos  7^  sin  <pt  cos  cos  (pi  J 

Thus  distance  of  the  i  —  th  aircraft  from  its  reference  in  the  Kinematic  frame  Ffci  is 


given  by: 


(1.46) 
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Chapter  2 


Formation  Flight  Control 


2.1  Formation  Flight  Control 

As  stated  in  the  introduction,  one  of  the  main  current  approaches  to  the  prob¬ 
lem  of  control  and  coordination  of  multi-vehicle  formations  is  represented  by  the 
Leader /Wingman  structure.  Within  such  approach,  one  of  the  aircraft  (Leader)  is 
chosen  to  direct  the  formation,  following  a  prescribed  path  (or  a  Virtual  Leader)  and 
all  the  other  aircraft  (Wingmen)  are  expected  to  maintain  a  fixed  relative  distance  to 
a  reference. 

Let  us  now  consider  two  variations  of  Leader /Follower  structure:  the  first  where 
the  reference  is  a  neighborhood  aircraft  and  the  second  where  the  reference  is  the 
Leader.  In  the  first  case,  the  rear  Wingmen  exhibit  a  poorer  transient  response  with 
respect  the  front  ones  due  to  error  propagation  while,  in  case  of  each  Follower  takes  the 
trajectory  reference  from  the  Leader  of  formation,  such  configuration  may  be  critical 
because  each  Follower,  that  is  directly  connected  to  the  Leader,  has  no  information 
about  its  distance  from  the  other  Followers,  and  therefore  it  would  not  be  capable  of 
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avoiding  collision.  Thus,  Leader /Follower  structure  may  not  be  the  best  strategy  to 
perform  complicated  maneuvers,  especially  in  multi-aircraft  formation  flight.  In  fact, 
each  aircraft  in  the  formation  must  cooperate  in  order  to  maximize  the  possibilities 
for  a  formation  to  obtain  and  retain  its  structure.  The  aircraft  in  the  formation  must 
work  together  to  achieve  a  common  goal. 

To  overcome  the  limitations  of  Leader /Wingman  structure,  a  different  strategy  is 
proposed,  based  on  the  behavior  of  migratory  birds  [Anderson  and  Robbins,  1998]. 
The  aircraft  in  a  formation  are  not  longer  referring  to  each  other,  but  they  are  required 
to  keep  a  specified  distance  from  an  imaginary  point  called  Formation  Geometry 
Center  (FGC).  The  FGC  position  depends  on  the  relative  distances  between  the 
aircraft  in  the  formation  itself;  this  allows  each  aircraft  to  have  the  capability  of 
sensing  other  vehicles  movement  from  the  nominal  position  in  the  formation.  In 
the  presence  of  disturbances,  for  instance,  if  one  of  the  aircraft  loses  its  position, 
the  other  senses  the  change,  and  depart  momentarily  from  the  prescribed  trajectory, 
manoeuvreing  all-together  in  order  to  reconstitute  the  formation  geometry.  Once 
the  geometry  has  been  reached  again,  all  aircraft  continue  to  follow  the  prescribed 
trajectory. 

2.1.1  Natural  Behavior  of  Migratory  Birds 

For  long  distance  migrational  flight,  birds  of  several  species  tend  to  move  in  a  form¬ 
ation,  flying  close  to  each  other  maintaining  a  defined  geometrical  shape.  One  of 
the  most  interesting  considerations  is  the  fact  that  during  a  migrational  flight  if  one 
or  more  elements  of  the  group  loses  its  position  in  the  formation,  the  others  leave 
the  migration  trajectory  and  ’wait’  for  the  lost  ones  until  the  formation  shape  is 
reconstituted. 
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There  are  two  main  reasons  that  birds  fly  in  a  formation;  the  first  reason  is  re¬ 
lated  to  aerodynamic  considerations  while  the  other  is  due  to  the  ’social  behavior’ 
of  some  species  (see  reference  [Tyne  and  Berger,  1976]).  In  terms  of  aerodynamics 
effects,  birds  take  advantage  of  the  induced  velocity  produced  by  the  wing  tip  vortex 
phenomenon:  the  inner  wing  of  each  bird  in  a  V  formation,  for  example,  gains  an 
increase  in  lift  and  then  a  reduction  in  induced  drag  from  the  upward  rising  side  of 
the  vortex  left  by  the  outer  wing  of  the  bird  ahead.  For  this  reason,  it  is  important 
that  each  bird  in  the  group  keep  its  position;  losing  position  by  one  or  more  birds 
in  a  migrational  flight  means  a  non-negligible  of  aerodynamics  efficiency  loss.  On 
the  other  hand,  birds  like  geese  and  swans  form  ’family’  groups:  offsprings  remain 
with  parents  one  or  two  seasons  after  the  birth  and  fly  together  with  them  during 
the  migration.  The  elements  in  these  formations  know  each  other  and  try  to  remain 
together  independently  from  aerodynamics  advantages  while  other  birds  like  storks 
live  in  non-familiar  group,  but  fly  together  with  others  just  in  order  to  improve  the 
efficiency  of  the  migration  (especially  during  food  searching  or  mating  season).  From 
these  motivations  it’s  possible  to  assume  that  the  preceding  considerations  to  be 
reasonable.  A  two-aircraft  formation  is  considered  in  the  present  work.  Each  aircraft 
will  be  represented  using  the  modified  three-degrees  of  freedom  point-mass  model 
described  in  the  previous  section. 

2.1.2  Formation  Geometry  Center 

As  described  in  the  previous  section,  aircraft  do  not  refer  to  each  other  and,  in  order  to 
maintain  formation  geometry  an  imaginary  point  called  Formation  Geometry  Center 
(FGC)  is  introduced  and  each  aircraft  must  keep  a  prescribed  distance  from  this  point. 
The  FGC  dynamics  for  an  na-aircraft  formation  can  be  represented  by  the  following 
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differential  equations: 
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By  integrating  the  preceding  equations,  the  position  of  the  FGC  in  the  Earth-fixed 
frame  ( Pfgc )  is  found  and  the  distance  between  the  FGC  and  the  i  —  th  aircraft, 
referred  to  the  frame  Fq,  is  defined  as: 


&i  =  P  FGC  Pi  (2-4) 

where  Pfgc  and  Pl  are  the  position  of  the  FGC  and  the  i  -  th  aircraft  respectively. 
The  transformation  of  the  distance  vector  from  the  inertial,  Earth-fixed  frame  Fq  to 
the  Kinematic  frame  iq,  is  modelled  by  equation  (1.46). 


2.1.3  Inner-Loop  Synthesis 

Prior  to  the  design  of  any  formation  controller,  each  aircraft  of  the  formation  must 
feature  adequate  tracking  of  a  commanded  trajectory  capabilities  through  an  inner 
loop  controller.  The  inner-loop  controller  is  based  on  the  model  for  an  individual 
aircraft  in  undisturbed  air  described  in  the  previous  section.  The  following  three  lag 
filters  are  introduced  to  model  the  fact  that  the  aircraft  cannot  change  bank  angle 


(</>),  load  factor  (n)  or  thrust  (T)  instantaneously. 

T=(Tc-T)/n 

(2.5) 

j>  =  {4>c-  4>)/n 

(2.6) 
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n  =  (nc  -  n)/r„  (2.7) 

Tc,  (pc  and  nc  are  the  commanded  values  for  input  variables.  The  time  constants  Tt, 
t in  and  Tn  will  be  aircraft  specific.  To  implement  the  inner-loop  controller,  a  dynamic 
inversion  law  is  used,  [Anderson  and  Robbins,  1998].  The  desired  trajectory  vector  is 
written  in  terms  of  a  commanded  airspeed  (14),  flight  path  angle  (7C),  and  heading 
angle  (yc).  It  is  assumed  that  the  desired  trajectory  will  be  governed  by  the  following 
linear  time-invariant  equations: 


V  =  ojv(Vc  -  V ) 

(2.8) 

7  =  w7(7c  -  7) 

(2.9) 

X  =  ux(Xc  ~  X) 

(2.10) 

where  u/y,  w7  and  ux  are  the  selected  bandwidths  of  the  controller  and  they  dictate 
how  quickly  the  actual  aircraft  trajectory  changes  with  respect  to  the  new  desired 
value.  To  derivate  the  dynamic  inversion  control  law,  the  commanded  rates  (2.8)- 
(2.10)  are  set  equal  to  the  associated  actual  rates  (1.35)-(1.37),  and  solving  for  thrust, 
bank  angle,  and  load  factor.  The  computed  thrust,  bank  angle,  and  load  factor 
become  the  commanded  values  needed  for  (2.5)-(2.7). 

The  airspeed  command  is  obtained  by  setting  equation  (2.8)  equal  to  (1.35)  and 
solving  for  thrust.  This  yields: 

Tc  =  D  4-  uv(Vc  —  V)m  +  mgsinj  (2-11) 

Substituting  equation  (2.9)  in  (1.36), 

V 

nc  cos  <pc  =  —  [fey  (7C  -  7)  +  cos  7]  =  ci  (2-12) 
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and  (2.10)  into  (1.37)  leads  to: 


nc  sin  (pc  =  — kx  (yc  ~  x)  cos  7  =  c2  (2.13) 

9 

Finally,  equations  (2.12)  and  (2.13)  can  be  combined  to  yield  the  required  load  factor 
and  bank  angle  commands: 

nc  =  \/ci2  +  c22  (2-14) 

and 

4>c  =  tan~ 1  ^  (2.15) 

Now  the  aircraft/autopilot  model  is  obtained  using  the  equations  derived  above,  the 
model  for  a  n-aircraft  formation  is  obtained  by  introducing  the  force  coefficient  vari¬ 
ations  and  the  relative  distances  dynamics: 

®i  =  /i(®i,«i)  +  \pV?S\  (A/i  •  CFlf) 

® na 

di 

dna  =  9na(.'^ li  •  •  •  )  ®»«) 

where  /(.)  contains  the  aircraft /autopilot  model  and  dL  is  the  distance  between  the 
z-th  aircraft  and  the  FGC.  This  is  the  complete  nonlinear  point-mass  model  that  is 
used  in  simulation. 

2.1.4  Formation  Controller  Design 

A  Formation  Controller  ( FC )  is  needed  to  reproduce  the  natural  behavior  of  migra- 
tional  birds.  For  the  purpose  of  FC  design,  linearization  around  a  selected  flight 


f2{xna,una)  +  I p F„2  Sna  (A/no  •  CFnaf) 

9i(x\,  •  •  • ,  ) 


(2.16) 
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condition  of  the  previous  nonlinear  model  yields  the  linearized  set  of  equation  de¬ 
scribed  by  the  following  state  space  model: 
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The  Formation  Controller  (FC)  is  given  by  two  separate  control  systems:  a  trajectory 
controller  (Kt)  and  a  position  controller  ( Kp ).  The  main  objective  of  the  trajectory 
controller  is  to  provide  tracking  of  a  prescribed  path  in  terms  of  desired  velocity,  flight 
path  and  hading  angle:  rT—(Vd,  7 d,  Xd),  while  the  position  controller  is  designed  to 
maintain  inter-aircraft  distances  in  order  to  give  the  formation  a  desired  geometric 
shape.  Trajectory  and  position  controllers  receive  path  error  information,  that  is 
the  difference  between  current  and  desired  path,  and  FGC-distance  error,  that  is  the 
difference  between  current  and  desired  distance  from  FGC,  respectively: 


(2.18) 


eT  —  rT  yT 
Cp  =  rP  ~  Up 

and  they  generate  trajectory  and  position  commanded  vectors  Up  and  up  defined  as: 

up  =z  KpSp 

(2.19) 

Up  — —  K^  pG  p 

For  system  (2.17)  two  LQ-Servo  controllers  were  developed  providing  gain  matrices 
Kp  and  Kp.  Such  matrices  were  obtained  through  the  minimization  of  the  quadratic 
cost  indexes: 


poo 

j(-)  =  /  [u>  R(  )  u  +  e'(.)  Qe(.)  e(.)4- 

Jto 


(2.20) 
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where  Qe,  Qr  and  R  are  positive  definite  matrices.  They  regards  the  minimization 
of  the  desired  output  vector,  residual  state  vector  and  input  vector  respectively.  The 
following  assumptions  are  introduced: 

C  —  I  —  LC  (2.21) 

l  =  c(cc,)~1  (2.22) 

These  relationship  allows  to  rewrite  equation  (2.20)  as: 

poo 

J(.)  =  /  [«'  R(.)  u+(x  -  x )'  Q(.)  (x  -  x)  ]  dt  (2.23) 

Jto 

where: 


Qi.)  =  C'Qr(.)C  +  C'Qe{.)C 

x  =  L 


rT 

rP 


(2.24) 

(2.25) 


The  resulting  commanded  vector  uc  is  a  convex  combination  of  the  two  previous 
control  laws: 

uc  —  rjUr  +  (1  —  rf)up  (2.26) 


where  rj  e  [0, 1],  may  be  a  constant  or  a  function.  The  prescribed  path  can  be 
commanded  by  one  of  the  aircraft  of  the  formation  or  by  a  ground  station  o  by  a 
Virtual  Leader  [G.Mancino  et  al.,  1999]. 

Assume  r]  to  be  an  exponential  function  of  position  error  eP: 

r)  =  61  exp  ^ 0“^  (2-27) 

During  a  perturbed  flight  ,  there  may  be  one  or  more  aircraft  with  a  position  error 
with  respect  to  the  nominal  configuration.  This  cause  the  FGC  move  to  a  new 
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position  and  then  all  the  aircraft  within  the  formation  have  a  position  error  ep.  The 
command  vector  uc,  depends  both  on  position  error  ep  and  trajectory  error  ep.  and 
so  the  aircraft  in  the  formation  may  not  be  able  to  follow  the  prescribed  path  exactly 
until  the  geometry  is  re-established.  When  the  formation  has  the  desired  shape,  the 
position  error  ep  is  zero  and  rj= 1  for  each  aircraft  .  This  causes  the  commanded 
vector  uc  be  given  only  by  the  contribution  of  the  trajectory  controller  Kp  and  all  the 
aircraft  will  follow  the  desired  trajectory  r-j- .  allows  to  achieve  a  cooperative  behavior. 
By  varying  the  function  77  each  aircraft  could  have  its  own  behavior.  The  stability  of 
the  control  law  expressed  by  Equation  (2.26)  is  provided  by  the  following  proposition. 

(Positive  Real  Lemma)  Given  the  LMI  problem: 


P>0, 


ATP  +  PA  +  Q  PB 
BTP  R 


<  0 


(2.28) 


where  A  E  RnXn,  B  E  RpXn  and  P  =  PT  E  RnXn.  If  R  =  RT  and  Q  =  QT  are 
positive  definite,  the  LMI  problem  (2.28)  is  equivalent  to  the  following  quadratic 
matrix  inequality: 

AtP  +  PA  +  Q  -  PBR~1BtP  <  0  (2.29) 


Given  a  system,  whose  dynamics  is  modeled  by  the  standard  state  space  model 
(A,  B,C,  D)  and  given  the  matrices  Qy,  Q2,  and  R  positive  definite.  If  exist  two 
matrices  Pi  and  P2  positive  definite  so  that  the  two  optimal  controllers  Ky  —  —R~1BTPi 
and  K2  =  —R~1BtP2  stabilize  the  system,  then  the  convex  combination  of  the  two 
controllers,  K  =  aKy  +  /3K2,  stabilizes  the  system  as  well. 

Proof:  If  controllers  Ky  and  K2  stabilizes  the  system  then,  for  the  previous 


34 


proposition: 


ATP1  +  P1A  +  Ql  PXB 
BTP1  R 


<  0 


and: 


<  0 


ATP2  +  P2A  +  Q2  p2b 
btp2  r 

Let  now  consider  the  convex  combination  of  (2.30)  and  (2.31): 

a  ( ATP1  +  P2A  +  Qx)  +  P(AtP2  +  P2A  +  Q2)  (, aP \  +  f3P2)B 
BT{oiP\  +  fiP2)  R 

According  to  Proposition  1: 


(2.30) 


(2.31) 


<0  (2.32) 


a  (AT P\  +  P2A  +  Qi)  +  0(AtP2  +  P2A  4-  Q2)  ^ 

(aPi  +  pP2)BR~1BT{aPi  +  /3P2)  (2.33) 

and  thus: 

AtP  +  PA<  PBR~1BtP  -  (aQi  +  pQ2)  (2.34) 

where  P  =  aPx  +  0P2.  Let  now  choose  the  following  Lyapunov  function: 

V(x)  =  xTPx  (2.35) 

where  P  is  positive  definite.  The  time  derivative  is: 

V(x)  =  xTPx  +  xTPx  (2.36) 

and  it  must  be  negative  defined,  to  guarantee  stability: 

V(x)  =  xT{AT-BR-1BT(aP1  +  /3P2)}Px  +  xTP{A-BR-1BT(aP1+/3P2)\x  (2.37) 
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By  choosing  P  =  aP\  +  PP2,  and  introducing  the  inequahty  in  equation  2.34  leads 
to: 

V(x)  =  xT[AT(aP1  +  pP2)  +  (aPj  +  pP2)A}x  -  2xT[(aP1  +  j3P2)BR-1BT(aP1  +  0P2)]x 
<  xT[-aQi  -  (3Q2  —  (aPi  +  PP^BR-1  BT  (aPi  +  pP2)]x 

(2.38) 

All  the  terms  are  negative,  then  the  convex  combination  of  the  two  controllers  K\ 
and  K2  stabilize  the  system. 

□ 

2.2  Simulation  Results 

To  validate  the  overall  control  strategy,  simulations  were  performed  for  close  forma¬ 
tions  consisting  of  two  unmanned  aircraft  as  shown  in  Figure  2.1.  The  aircraft  model 
includes  aircraft /autopilot  model,  the  Distributed  Horse-Shoe  Vortex  code  and  FGC 
relative  distance  dynamics.  The  Formation  Control  scheme  is  shown  in  Figure  2.2 
and  is  simulated  in  MATLAB  environment.  The  relative  nominal  distances  between 
aircraft  and  FGC  are  selected  to  be  5  m  along  the  x  and  y-axes.  The  altitude  is  the 
same  for  both  aircraft  at  300  m. 

The  first  simulation  is  a  path  following  task.  Each  aircraft  receives  the  commanded 
trajectory  from  the  VL.  Starting  from  a  steady-level  flight  condition  at  20  m/sec, 
each  aircraft  is  commanded  to  perform  a  heading  change  of  -30  deg.  Trajectory 
tracking  is  achieved  and  the  relative  distances  between  the  aircraft  are  maintained  at 
nominal  values.  Figure  2.3  shows  aircraft  response  to  the  heading  command  in  case 
of  Leader/Wingman  structure  and  FCG-based  structure.  The  figure  shows  how  the 
error  propagation  is  reduced.  Figure  2.4  and  2.5  show  the  relative  distance  between 


36 


Figure  2.1:  Formation  Geometry  with  FGC 


Figure  2.2:  Formation  Controller 
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Figure  2.3:  Aircraft  Responses  to  a  -30  deg  Heading  Change  in  a  L-W  Structure 
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Time 


Figure  2.4:  Aircraft  1,  FGC  Distances  during  Heading  Change 

aircraft  and  the  FGC  during  the  heading  change  manoeuvre  (FGC-based  structure). 

The  second  simulation  is  a  formation  geometry  variation.  Each  aircraft  is  com¬ 
manded  to  increase  its  relative  distance  from  FGC  from  5  to  7  m  along  x  and  y-axis. 
Figure  2.6  and  2.7  show  the  relative  distance  between  aircraft  and  the  FGC  while 
Figure  2.8  shows  the  airspeed  time  history  during  such  manoeuvre. 

The  last  simulation  shows  how  the  FC  could  reproduce  the  behavior  of  migrational 
birds.  The  initial  condition  is  a  steady-level  flight.  Each  aircraft  has  an  initial  airspeed 
of  20  m/sec  that  is  the  commanded  trajectory.  A  speed  perturbation  is  introduced 
to  aircraft  2  and  it  slows  down  with  respect  to  aircraft  1.  Figure  2.9  shows  speed 
profiles  for  the  two  aircraft.  It  is  clear  how  aircraft  1  stops  following  the  prescribed 
velocity  and  ’waits’  for  aircraft  2  in  order  to  maintain  the  nominal  distances.  Figure 
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Figure  2.6:  Aircraft  1-FGC  relative  I 
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Figure  2.9:  Airspeed  Time  History  during  perturbed  Flight 


2.10  shows  the  x— axis  relative  distance  between  aircraft  during  perturbed  flight. 
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Figure  2.10:  X-Distance  from  FGC  during  perturbed  Flight 
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Chapter  3 


Reconfiguration  in  the  presence  of 
Communications  Failures 


Coordination  and  management  within  a  formation  of  multiple  unmanned  air  vehicles 
(UAV)  is  a  critical  issue  for  utilizing  their  full  potential  in  operational  situations. 
While  military  and  civilian  mission  scenarios  would  benefit  from  the  addition  of 
autonomous  individual  UAV,  compared  to  non-autonomous  or  manned  aircraft,  it 
is  clear  that  formation  flight,  with  an  effective  coordination  strategy,  could  lead  to 
superior  performance  and  resources  utilization. 

Coordinated  control  of  multiple  vehicles  has  been  widely  studied  in  the  past. 
Kangl  and  co-workers  addressed  the  problem  of  formation  coordination  and  recon¬ 
figuration  of  multiple  micro  satellites,  [Mesbahi,  M.  and  Hadaegh,  F.  Y.,  1999]  and 
[Meshabi,  M.  and  Hadaegh,  F.  Y.,  2001]  approached  the  Leader /Wingmen  structure 
for  multiple  spacecraft  with  graph  theory  and  linear  matrix  inequalities  (LMI)  tech¬ 
niques,  while  [Godbole,  D.  N.  et  al,  2000]  and  others  presented  a  communication  pro¬ 
tocol  for  the  operation  of  an  automated  highway  system  in  the  presence  of  failures. 
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Flight  coordination  of  multiple  UAV  was  recently  addressed  by  [F.  Giulietti  et  al. .  2000], 
McLain  and  others  [McLain,  T.  W.  et  al. ,  2000]  presented  results  on  the  decentral¬ 
ized  trajectory  planning  for  coordinated  rendezvous  of  multiple  air  vehicles.  In  this 
section  we  investigate  possible  formation  structures  to  be  used  in  an  operational  en¬ 
vironment,  with  emphasis  on  optimization  with  respect  to  data  information  transfer 
among  the  elements  of  the  formation  itself. 


3.1  Formation  Flight  Management 

The  main  issues  involved  in  control  and  management  of  an  aircraft  formation  are 
trajectory  tracking  and  inter-aircraft  relative  distance  regulation.  In  the  case  of  de¬ 
centralized  management,  each  vehicle  in  the  formation  needs  to  exchange  data,  such 
as  position  and  trajectory  information.  Many  different  configurations  could  be  found 
for  the  communication  flow  within  a  formation,  and  not  all  of  these  configurations 
may  provide  good  performance.  Thus,  the  first  step  is  to  find  an  “optimal”  one, 
among  different  configurations  for  information  exchange. 

Optimization  of  available  communication  channels  based  on  a  cost  function  fig¬ 
ure  of  merit  can  be  achieved  using  a  variety  of  methods;  here  the  problem  is  set  up 
using  graph-programming  techniques.  The  formation  is  viewed  as  an  oriented  graph: 
the  nodes  represent  the  aircraft,  while  the  physical  communication  channels  between 
vehicles  create  the  arcs.  The  graph  is  oriented  because,  in  the  most  general  case, 
channels  are  not  bi-directional;  this  is  not  a  limitation,  since  two  nodes  can  be  con¬ 
nected  by  two  opposite  direction  arcs  to  model  a  bi-directional  channel.  The  graph 
must  also  be  connected  because,  if  two  sub-graphs  exist  without  any  arc  connecting 
them,  the  aircraft  in  the  two  groups  cannot  behave  as  a  single  formation,  but  rather 
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act  as  two  separate  formations. 

In  the  optimization  process,  each  arc  must  be  given  a  weight.  The  optimization 
■will  minimize  the  total  cost  of  the  information  paths  throughout  the  formation  using 
the  arcs  weights  to  evaluate  the  cost  of  a  connection.  The  weights  for  the  arcs  can  be 
selected  by  taking  into  account  general  mission  requirements  related  to  the  formation 
flight  such  as: 

•  Closed-loop  performance:  a  measure  of  the  capability  of  the  formation  con¬ 
trol  system 

to  maintain  the  prescribed  path  and  the  nominal  inter-aircraft  distances,  may  be 
used  to  set  the  weight  of  the  arc. 

•  Formation  safety:  communications  between  neighborhood  aircraft  will  have 
a  lower 

cost.  Using  distance  references  with  adjacent  aircraft  might  limit  the  risk  of 
aircraft  conflicts  compared  to  using  a  common  reference  for  all  aircraft. 

•  Type  of  communication  channel:  in  case  a  non-radio-based  (or  a  non-omni- 
directional) 

communication  channel  is  used,  the  geometry  of  the  formation  might  influence 
the  possibility  of  exchanging  data  between  two  airplanes  that  are  not  closely  spaced 
or  that  are  hidden  by  other  vehicles. 

In  general,  since  the  position  error  propagates  and  increases  throughout  the  form¬ 
ation,  the  optimization  algorithm  should  include  the  minimization  of  the  minimum  er¬ 
ror  propagation  path.  Once  an  optimal  solution  for  the  communication  flow  is  found, 
the  next  step  in  the  formation  management  design  consists  in  giving  the  structure  ad¬ 
equate  robustness  to  communication  failures.  A  failure  in  the  communication  occurs 
when  one  or  more  aircraft  of  the  formation  loses  the  information  exchange  capability 
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(send  or  receive  data).  Obviously  the  loss  of  the  aircraft  itself  is  a  communication 
failure:  both  receiving  and  sending  information  capabilities  are  lost.  After  a  failure, 
there  may  be  one  or  more  connections  lost  and  then  a  new  channel  configuration 
must  be  found.  The  resulting  configuration  will  not  be  optimal,  because  of  the  loss  of 
one  or  more  channels,  but  it  will  be  the  optimal  solution  according  to  the  new  set  of 
nodes  and  arcs.  The  algorithm  for  the  re-optimization  of  the  inter- aircraft  connection 
is  triggered  by  the  fault  detection,  and  it  is  decentralized  for  faster  reconfiguration 
time,  and  information  other  than  that  strictly  needed  for  the  formation-keeping  con¬ 
trol  system  must  be  exchanged  on  the  data  channels.  The  reconfiguration  process 
must  be  the  same  for  all  aircraft;  that  is,  the  local  copy  of  the  graph  describing  the 
formation  communications  must  be  identical  in  all  aircraft  at  all  times. 

There  are  cases  in  which,  after  a  reconfiguration  of  the  inter-aircraft  connections, 
a  geometrical  reconfiguration  of  the  formation  is  needed  as  well.  Such  cases  are:  air¬ 
craft  loss,  where  the  geometrical  reconfiguration  is  related  to  aerodynamic  efficiency 
effects,  the  data  receiving  capability  loss  for  a  ’leaf’  aircraft  of  the  graph  or  the  data 
sending  capability  loss  by  the  root  of  the  graph.  In  the  latter  cases,  the  geometrical 
reconfiguration  is  needed  to  keep  the  information  flow  (under  the  hypothesis  that 
information  flows  from  the  front  aircraft  towards  the  rear  aircraft).  The  geomet¬ 
rical  reconfiguration  of  the  formation  is  described  by  a  set  of  heuristic  rules  that  are 
implemented  through  several  schemes,  called  reconfiguration  maps  (RM),  presented 
later. 

Figure  3.1  shows  the  complete  control  and  management  architecture  that  will  be 
used  as  reference  in  the  rest  of  the  paper.Where: 

BC=Broadcast  Channel 

RM  =  Reconfiguration  Manager 
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Figure  3.1:  Reference  Management  and  Formation  Control  Architecture 


RX  =  Receiver 
TX  =  Transmitter 

The  gray  block  in  the  diagram  represents  the  aircraft  dynamics,  the  inner  loop 
autopilots,  and  the  formation  flight  control  system.  This  single  block  is  actually  a 
two-loop  system,  with  three  inner  loop  autopilots  for  tracking  of  commanded  speed, 
flight  path  and  heading  angles,  and  an  outer  loop  (formation  control)  responsible  for 
trajectory  following  and  inter-aircraft  distance  control.  For  the  purpose  of  the  present 
work,  a  three-degree  of  freedom  (3-DOF)  point  mass  model  was  used.  Using  standard 
aerospace  notation: 


V  F-D) 

V  —  g  sm  7 

(3.1) 

m 

7  =  p:  (n  cos  0  —  cos  7) 

(3.2) 

g  n  sin  <fr 

V  COS7 

(3-3) 

Assuming  perfect  modeling,  aircraft  dynamics  can  be  feedback  linearized  with  the 
following  control  laws: 
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T  =  kv(Vd  -  V)m  +  mgsiny  +  D  (3.4) 

ncos  (j)  =  —  [k^  (7^  —  7)  4-  cos  7]  =  cx  (3.5) 

n sin  4>  =~~kx  (xd  ~  x)  cos  7  —  c2  (3-6) 

the  resulting  linear  system  becomes: 

V  =  Kv  (Vd  -  V ) 

7  =  Ky  (7 d  -  7)  (3-7) 

X  =  Kx  (Xd  ~  X) 

To  maintain  the  desired  formation  geometry,  each  aircraft  must  keep  its  relative 
position  within  the  formation.  The  formation  management  is  derived  using  Dijkstra’s 
algorithm3,  and  reconfiguration  maps  give  the  reference  position,  according  to  the 
results  of  the  optimization  procedure.  In  the  remainder,  a  formation  of  6  aircraft  will 
be  used  as  example  (see  Figure  3.2). 

3.2  Optimal  Communications 

As  outlined  in  the  previous  section,  an  aircraft  formation  is  described  using  graph 
theory.  The  presence  of  an  outgoing  arc  in  a  node  in  the  graph  implies  the  capability 
of  transmitting  information,  while  an  incoming  arc  is  related  to  the  capability  of 
receiving  information.  Two  virtual  devices  model  such  capabilities:  a  transmitter 
(TX)  and  a  receiver  ( RX ).  These  devices  are  “virtual”  in  the  sense  that  failure 
implies  the  loss  of  the  device  capability,  irrespectively  of  what  subcomponent  has 
actually  failed  (antennas,  CPU,  transmission  bus,  etc.).  In  the  presence  oiTX  and/or 
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Figure  3.2:  Allowed  Formation  Geometries 

RX  failure  all  the  outgoing  and/or  incoming  arcs  are  lost,  while  in  case  of  aircraft 
loss,  all  incoming  and  outgoing  arcs  from  the  node  representing  the  lost  aircraft  are 
neglected.  It  is  important  to  notice  that  considering  TX  and  RX  separately,  allows 
the  extension  of  the  present  technique  to  non-radio-based  communication  devices. 

3.2.1  The  Virtual  Leader 

During  the  mission,  the  reference  trajectory  could  be  provided  in  two  ways.  It  may 
be  stored  in  one  (or  more)  on-board  computers,  or  it  may  be  provided  remotely 
from  a  ground  station  as  well  as  from  a  manned  aircraft.  In  both  cases,  not  all  the 
aircraft  may  be  required  to  know  the  reference  trajectory.  However,  according  to  the 
properties  of  the  Leader/Wingman  structures,  at  least  one  aircraft  in  the  formation 
knows  the  reference  trajectory.  The  reference  trajectory  can  be  seen  as  the  effective 
leader  of  the  formation,  by  introducing  an  imaginary  point  moving  in  the  space, 
tracking  the  path  prescribed  for  the  formation  and  rigidly  followed  by  all  the  aircraft 
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of  the  formation.  Such  imaginary  point  is  called  Virtual  Leader  (VL)  and  can  be 
formalized  through  the  following  definitions: 

Definition  1:  The  nodes  representing  the  aircraft  of  the  formation  belong  to  the 
set  :L  =  {v\,v2, . . . ,  }  ,n  =  number  of  aircraft 

Definition  2:  The  nodes  representing  the  aircraft  of  the  formation  knowing  the 
reference  trajectory,  belong  to  the  subset  of  V  :  L  =  ■•■Jp}  >P  5:  n- 

Definition  3:  The  graph  F  =  (V,  E ),  where  E  is  a  finite  set  of  arcs,  is  a  formation 
graph  (FG)  if  and  only  if:  \/v  e  ( V/L)3l  G  L,  Such  that  one  of  the  following  conditions 
hold: 

Such  that  one  of  the  following  conditions  hold: 

1.  (l,v)  e  E 

2.  3 C  =  {vl,  v2, ...,  vk}  ,  k  >  1,  C  C  (V/L)  e  E/\(Vi  =l,...,k-l,  (vi,  vi  +  1)  €  E) . 

Definition  4:  Given  a  node  n,  the  graph  F/  =  (V/,  El),  where  V'  =  V  v',  E'  = 

E  E  ,  and  E  is  a  finite  set  of  arcs,  is  an  extended  formation  graph  ( EFG )  if  and 
only  if: 

F  =  ( V,E )  is  a  formation  graph  (FG) 

1.  E  contains  every  arc  outgoing  from  the  node  n  to  the  nodes  belonging  to  the 
set  L 

2.  The  node?/  is  called  Virtual  Leader  (VL). 

Definition  5:  An  EFG  is  defined  feasible  if  and  only  if  it  is  connected  and  the 
nodes  have  at  most  one  incoming  arc. 

Once  the  VL  has  been  defined,  the  reference  trajectory  can  be  inserted  in  the 
optimal  communication  configuration  procedure. 
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3.2.2  Graph  Theory  Approach 

The  send-receive  nature  of  communications  leads  to  an  oriented  graph;  the  direction  of 
the  arcs  indicates  the  direction  of  data  flow  and  the  available  communication  channels 
can  form  cycles8;  with  a  broadcast  communication  scheme,  for  instance,  all  possible 
arcs  exist  among  nodes.  Furthermore,  the  arcs  capacity  is  unlimited;  there  is  no 
evident  physical  meaning  of  a  communication  channel  with  limited  "capacity."  The 
arcs  weight  can  be  set,  without  loss  of  generality,  to  values  greater  than  zero.  The 
following  propositions  are  useful  in  the  optimization  procedure. 

:  If  an  EFG  contains  a  cycle,  the  cycle  does  not  contain  VL. 

:  Suppose  the  VL  is  included  in  the  cycle.  From  the  definition  of  cycle  node,  the 
VL  should  have  an  outgoing  arc  and  an  incoming  arc.  This  is  in  contrast  with  the 
condition  2  of  Def.  4.  Thus  the  VL  is  not  included  in  the  cycle.  ■ 

:  A  feasible  EFG  contains  no  cycles. 

:  Suppose  that  a  cycle  exists.  VL  is  not  included  in  the  cycle  (Prop.  1)  but  it 
must  be  connected  to  the  cycle  (Def.  5).  The  VL  may  not  be  connected  directly 
to  the  cycle  because  both  cycle  and  VL  admit  only  outgoing  arcs.  If  nodes  were 
added  to  create  a  path  between  the  cycle  and  the  VL,  they  also  could  have  at  least 
one  incoming  arc  (Def.  5).  Then  there  is  no  additional  node  that  could  receive  the 
outgoing  arc  from  the  VL.  Thus  EFG  does  not  contain  any  cycle,  and  the  VL  will  be 
the  root  of  the  solution  tree.  ■ 

Under  these  assumptions,  the  problem  can  be  configured  as  a  shortest  path  prob¬ 
lem  (SPP),  and  Dijkstra’s  algorithm  is  used,  as  outlined  in  Figure3.3. 

Each  node  in  the  graph  represents  a  position  in  the  formation,  not  necessarily  an 
aircraft.  Node  i  has  a  potential  d(i)  and  a  preceding  node  p(i).  The  potential  is  a 
temporary  value  used  by  the  algorithm  and  is  initialized  to  +  infinity,  except  for  the 
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Figure  3.3:  Dijkstra’s  Algorithm  Flow  Chart 
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VL  that  has  zero  potential.  For  all  the  nodes  the  initial  value  for  the  preceding  node  is 
the  VL.  The  S  set  is  called  the  definitive-label  set  and  V’  is  called  the  temporary-label 
set.  Each  arc,  going  from  node  i  to  node  j  is  assigned  the  weight  Cij. 

The  algorithm  chooses,  in  the  temporary-label  set  V7,  the  node  that  has  the 
minimum  potential  and  moves  it  to  the  S  set  until  the  V’  set  is  empty.  Then,  for 
all  outgoing  arcs,  the  actual  node  computes  a  tentative  new  potential  for  the  arrival 
node.  If  this  new  potential  is  lower  than  the  previous  potential,  it  updates  that 
node  potential  and  sets  its  preceding  node  to  itself.  The  algorithm  runs  until  all 
nodes  have  been  assigned  a  potential.  This  solution  provides  the  minimum  non-cyclic 
path  connecting  all  nodes.  No  information  is  available  at  this  point  about  possible 
sub-optimal  axe  sets. 

3.3  Communication  Failures 

The  communication  system  is  modeled  with  a  TX  and  a  RX  device  on  each  aircraft. 
A  TX  or  a  RX  can  become  faulty  at  any  time,  and  a  fast  reconfiguration  of  the 
communication  channels  is  needed.  The  activation  of  a  new  communication  channel 
between  two  nodes  in  place  of  the  broken  one  is  determined  by  the  presence  of  a 
working  TX  and  a  working  RX  on  the  aircraft  occupying  the  nodes,  therefore  it 
depends  on  which  communication  terminal  breaks  down,  and  on  the  history  of  past 
communication  failures. 

Each  RX  device  must  be  able  to  reliably  detect  when  a  communication  channel 
is  lost.  This  means  when  the  corresponding  TX  has  become  faulty,  the  reference 
aircraft  has  left  the  formation,  or  its  own  RX  is  not  functioning.  While  the  RX 
device  is  deciding  whether  the  channel  is  definitively  lost  or  the  fault  is  temporary, 
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it  holds  its  output  and  notifies  the  formation  controller.  The  formation  controller 
must  know  that  is  using  held  data  because,  although  trajectory  information  can  be 
held  constant,  absolute  position  (that  is  GPS  data)  can  not,  so  it  must  interpolate 
position  data  using  trajectory  data. 

The  aircraft  whose  TX  stops  working  must  also  be  able  to  detect  it  because  this 
is  needed  by  the  formation  reconfiguration  procedures.  When,  for  any  reason,  one 
aircraft  TX  becomes  not  operational,  that  aircraft  can  no  longer  be  a  reference  for 
the  others.  The  TX  fault  has  the  effect  of  "deleting"  all  outgoing  channels.  From 
the  point  of  view  of  Dijkstra’s  algorithm,  the  arcs  leaving  that  node  may  be  assigned 
a  weight  equal  to  infinity.  These  arcs  will  not  be  used  in  any  optimal  path  where 
possible  other  connections  exist,  under  the  assumption  that  working  arcs  have  positive 
finite  weight.  All  the  aircraft  that  used  the  faulty  one  as  reference  must  reconfigure. 
From  the  standpoint  of  communication  reconfiguration,  the  case  of  an  aircraft  loss 
corresponds  exactly  to  the  broken  TX  case. 

3.3.1  Communication  Topology  Reconfiguration 

After  a  failure,  a  fast  reconfiguration  procedure  must  be  run  to  restore  formation¬ 
keeping  as  quickly  as  possible.  When  an  aircraft  detects  that  its  own  RX  is  faulty,  it 
must  reconfigure  the  formation  controller  to  use  the  V L  information,  if  no  connection 
to  the  VL  is  available,  the  aircraft  cannot  remain  in  the  formation.  When  an  aircraft 
detects  a  TX  fault  in  its  reference  that  is  it  loses  its  present  communication  channel, 
it  must  use  a  different  node  as  reference.  Dijkstra’s  algorithm  is  run  again  to  find  the 
new  optimal  set.  Changing  an  incoming  channel  node  affects  that  node’s  potential 
and  the  aircraft  using  it  as  a  reference  should  change  their  reference  as  well.  The 
failure  event  must  be  propagated  to  every  aircraft  of  the  formation  that  must  run  the 
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optimization  algorithm  even  if  their  incoming  channel  is  still  functioning.  A  special 
communication  channel,  called  Broadcast  Channel  is  used  to  this  end. 

It  is  necessary  to  ensure  that  each  run  of  the  optimization  algorithm  leads  to 
the  same  result  in  each  aircraft.  Since  the  implementation  of  Dijkstra’s  algorithm  is 
deterministic,  it  is  sufficient  to  ensure  that  each  aircraft  have  the  same  information 
on  present  nodes  occupation  and  on  working  TX s  and  it! As  to  guarantee  that  each 
separate  run  of  the  algorithm  in  all  aircraft  leads  to  the  same  solution.  This  will  be 
also  achieved  using  the  Broadcast  Channel. 

After  all  nodes  have  completed  the  reconfiguration,  the  new  graph  is  optimal 
again,  and  this  procedure  can  then  be  repeated  in  case  of  successive  failures  without 
having  to  reconsider  optimization  of  the  whole  graph.  The  procedure  must  be  the 
fastest  possible,  because  between  the  fault  detection  and  the  reconfiguration,  the 
aircraft  does  not  receive  any  trajectory  information  and  the  risk  of  conflict  with  other 
aircraft  increases  dramatically.  Due  mainly  to  this  motivation,  the  reference  channel 
reconfiguration  procedure  is  run  locally  on  each  aircraft. 

If  one  aircraft  does  not  find  an  alternative  communication  path,  it  must  leave 
the  formation  following  a  prescribed  escape  maneuver,  which  brings  it  safely  outside 
even  if  the  formation  is  maneuvering.  Before  taking  the  escape  path,  it  must  switch 
off  its  TX  to  prevent  the  aircraft  that  were  using  it  as  a  reference  to  follow  on  the 
escape  path.  The  basic  idea  beneath  the  safe  escape  procedure  is  that  the  aircraft 
is  first  brought  to  fly  at  a  different  altitude,  then  driven  away  from  the  estimated 
formation  direction,  and  then  driven  back  home  if  possible.  Three  different  altitude 
levels:  z-1,  z-2  and  z-3  apply  depending  on  position  inside  the  formation.  Figure  3.4 
shows  possible  escape  maneuvers. 
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Figure  3.4:  Safe  Formation  Escape  Maneuvers 

3.3.2  The  Broadcast  Channel 

To  keep  all  aircraft  informed  of  what  is  happening  to  a  specific  node,  and  which  of 
the  nodes  are  active  (that  is  nodes  occupied  by  a  vehicle),  an  additional  broadcast 
communication  channel  is  introduced  that  transmits  data  at  low  frequency;  this  new 
channel  is  called  Broadcast  Channel  ( BC ).  Communications  on  the  broadcast  channel 
are  asynchronous  because  the  formation  must  react  to  failure  events  with  the  shortest 
delay  possible.  At  the  same  time,  each  aircraft  notifies  its  presence  in  the  formation 
with  a  periodic  signal;  if  the  communication  period  is  Tactive  seconds,  all  aircraft  are 
updated  on  active  aircraft  changes  at  the  most  Tactive  seconds  after  the  fault.  The 
information  carried  on  the  BC  is  in  fact  vital  to  the  coordination  of  the  formation 
as  will  be  shown  later  on.  In  particular,  without  the  BC,  it  could  not  be  possible  to 
inform  all  aircraft  when  and  how  to  re-optimize  the  communications,  to  move  aircraft 
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inside  the  formation  without  moving  all  the  others  using  that  one  as  reference  and  so 
on. 

The  use  of  BC  communications  is  quite  large  during  a  post-fault  recovery  pro¬ 
cedure  but,  BC  communications  are  needed  to  coordinate  the  various  aircraft  and, 
although  the  carried  information  is  very  limited,  they  are  vital  for  the  propagation 
fault  events  and  to  avoid  conflicting  decisions.  It  must  be  stressed  that  no  arbitration 
and  no  conflicting  access  may  happen  to  the  BC,  unless  two  failures  are  simultaneous. 
While  a  fault  is  being  serviced,  other  failures  are  kept  in  a  priority  queue  and  serviced 
sequentially.  In  this  case,  the  aircraft  subject  to  failure  performs  at  least  the  com¬ 
munication  channel  re-optimization  procedure  to  ensure  safe,  although  sub-optimal, 
channel  usage. 

Failures  in  the  BC  transmitting  and  receiving  devices  were  not  considered  in  the 
present  work. 


3.4  Aircraft  Position  Reconfiguration 

After  the  formation  communications  have  been  re-optimized,  it  may  be  necessary  to 
move  the  aircraft  inside  the  formation  to  fill  holes  left  by  a  missing  aircraft  or  to 
exchange  two  or  more  aircraft  positions  to  reach  desired  formation  geometry,  and 
to  maximize  the  formation-keeping  capability  and  safety  of  all  aircraft  inside  the 
formation. 

Since  formation  safety  and  its  precise  control  capability  are  measured  by  the  total 
cost  of  the  communication  tree  after  a  generic  failure  the  new  communication  cost 
is  greater  than  or  equal  to  the  preceding  one.  By  moving  and  exchanging  two  or 
more  aircraft  inside  the  formation  some  arcs  that  were  assigned  a  weight  of  infinity, 


58 


as  unusable  arcs  because  of  broken  TXs  or  RXs,  could  re-gain  their  original  weight  or 
have  assigned  a  finite  weight;  thus  it  is  possible  to  decrease  the  total  communication 
tree  cost. 

The  introduction  of  heuristic  rules  embedded  into  the  reconfiguration  process  in 
terms  of  reconfiguration  maps,  accommodate  this  situation.  Since  the  node-changing 
decision  must  be  decentralized  too,  the  algorithm  that  makes  the  decision  must  be 
deterministic  in  order  to  avoid  simultaneous  conflicting  decisions  by  more  than  one 
aircraft  in  response  to  the  same  post-failure  reconfiguration  requirements.  These  rules 
constitute  an  expert  system  that  decides,  which  is  the  best  action  to  be  taken  after  a 
failure: 

•  An  aircraft  with  a  broken  RX  and  without  a  link  to  the  VL  must  leave  the 
formation  because  is  unable  of  maintaining  the  formation. 

•  After  the  loss  of  an  aircraft,  the  formation  geometry  must  be  brought  to  one 
of  the  desired  geometries  (See  Figure  3.6). 

•  An  aircraft  with  a  broken  RX  has  troubles  keeping  inter-aircraft  distances 
because  it  has  no  knowledge  of  other  aircraft  positions,  thus,  the  nearer  to  the  leader 
it  flies,  the  better  it  is. 

•  The  formation  leader,  that  is  the  aircraft  in  position  1,  can  lead  the  formation 
even  with  a  broken  RX. 

•  An  aircraft  with  a  broken  RX,  can  be  brought  to  lead  the  formation  if  the 
present  leader  has  a  working  RX. 

•  An  aircraft  with  a  broken  TX  cannot  be  a  reference  for  the  others,  and  then 
its  best  position  is  at  the  back  of  the  formation. 

Based  on  the  above,  a  number  of  reconfiguration  maps  was  developed,  which  the 
reconfiguration  manager  in  each  aircraft  applies  in  parallel  to  take  post-fault  decisions. 
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Figure  3.5:  Reconfiguration  Maps  for  6  to  5  Aircraft 


The  use  of  BC  is  vital  in  this  case;  since  it  notifies  each  aircraft  of  the  actions  taken 
by  the  others. 

3.4.1  Aircraft  Loss 

At  the  beginning  of  the  formation  mission,  the  communication  optimization  pro¬ 
cedure  is  run  to  find  the  optimal  communication  scheme,  but,  when  a  node  in  the 
formation  tree  becomes  free,  the  optimization  procedure  must  be  run  again  to  find  a 
new  working  communication  channels  set,  just  as  in  the  case  of  TX s  or  RXs  failures, 
but  with  the  constraints  given  by  the  allowed  geometries  shown  in  Figure  3.2. 

All  the  aircraft  in  the  formation  detect  the  event  of  an  aircraft  loss  by  listening 
to  the  BC.  If  after  Tactive  seconds  one  of  the  aircraft  has  not  sent  its  "alive"  signal 
through  the  BC,  that  aircraft  is  considered  lost. 

To  describe  the  maneuvers  needed  to  reach  the  new  configuration,  reconfiguration 
maps  were  used.  The  concept  of  RM  was  first  introduced  by  the  authors  in  Ref.  1, 
here  their  use  has  been  extended  to  cover  all  the  possible  cases  of  broken  TX s  and 
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Figure  3.6:  Reconfiguration  Maps  for  5  to  4  Aircraft 


RXs  in  the  formation.  The  RMs  are  grouped  depending  on  the  number  of  aircraft 
actually  occupying  the  formation. 

Figure  3.5  shows  the  RMs  for  the  loss  of  one  aircraft  in  a  six  aircraft  formation.  If 
position  1  (PI),  the  leader  position,  becomes  empty,  aircraft  in  position  2  (P2)  takes 
its  place,  unless  its  TX  is  not  working.  In  this  case,  aircraft  in  P3  moves  to  PI,  but 
if  its  TX  is  not  working  the  precedence  to  lead  the  formation  goes  to  aircraft  in  P2. 
If  P2  becomes  free,  aircraft  in  P5  takes  its  place,  unless  its  TX  is  broken,  in  this  case 
succeeds  aircraft  in  P4,  only  if  its  TX  is  working,  otherwise  aircraft  in  P6  takes  P2 
and  then  the  aircraft  in  P5  moves  to  fill  the  empty  place.  After  this  reconfiguration,  if 
the  aircraft  in  PI  has  a  nonfunctional  TX,  then  the  procedure  in  the  next  subsection 
is  activated  relative  to  the  leader  T X  failure.  The  RMs  for  free  position  in  the  third 
row  is  not  shown  because  it  is  trivial:  if  P4  or  P6  become  free,  aircraft  in  P5  takes 
the  free  place.  If  the  lost  aircraft  was  in  P5,  no  reconfiguration  is  necessary. 

Figure  3.6  shows  the  RMs  from  5  to  4  aircraft.  If  PI  is  free  the  behavior  is 
identical  to  the  6  to  5  RMs.  If  P2  becomes  free,  the  aircraft  in  P4  or  P6  are  moved 
depending  on  which  one  has  a  working  TX  and  with  precedence  to  the  aircraft  in 
P4.  The  remaining  aircraft  completes  the  reconfiguration  taking  P5.  If  P3  becomes 
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Figure  3.7:  TX  Failure  Management  Logic 

free,  the  RMs  are  specular.  If  P4  or  P6  become  free,  the  remaining  aircraft  in  the 
last  row  takes  P5. 

The  RMs  from  4  to  3  aircraft  are  not  shown  but  are  very  intuitive:  if  PI  is  free 
the  behavior  is  identical  to  the  6  to  5  RMs.  If  P2  or  P3  become  free,  the  aircraft 
in  P5  takes  the  free  position.  If  P5  becomes  free  no  reconfiguration  happens.  If 
the  formation  has  3  or  two  aircraft,  RMs  are  trivial  as  well  and  behave  as  already 
described  in  the  previous  cases. 

If  a  failure  occurs  in  some  aircraft  TX,  that  aircraft  is  first  moved  inside  the 
formation  to  become  a  leaf  of  the  tree,  where  the  TX  capability  is  not  needed.  If 
the  aircraft  already  occupies  the  last  row  or  its  RX  is  nonfunctional,  no  geometry 
re-configuration  is  needed.  If  a  re-configuration  is  necessary,  the  faulty  aircraft  moves 
to  a  position  outside  the  formation,  just  behind  the  last  row,  called  position  7  (P7). 
The  remaining  aircraft  reconfigure  the  geometry  using  the  RMs  as  soon  as  P7  has 
been  reached. 
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Figure  3.8:  Example  of  reconfiguration  after  a  TX  Failure 

When  reconfiguration  is  done,  the  aircraft  in  P7  re-enters  the  formation  in  P5 
if  the  total  number  of  aircraft  is  6  or  4,  in  P4  or  P6  depending  on  the  free  one 
if  the  aircraft  are  5,  in  P2  or  P3  if  the  aircraft  are  3  or  2.  During  these  phases 
coordination  is  essential  and  it  is  achieved  via  the  BC.  Figure  3.7  shows  a  high- 
level  finite  state  machine  description  of  this  process.  The  BC  communications  are 
represented  by  arrows  entering  or  coming  out  from  the  BC,  depending  whether  the 
corresponding  event  is  generated  by  the  state  transition  or  it  generates  the  transition 
respectively.  The  scheme  shows  also  how  an  aircraft  behaves  if  the  re-optimization 
process  produces  no  sub-optimal  channels  in  alternative  to  the  broken  one.  The  state 
marked  as  Aircraft  Lost  is  not  a  real  state  and  it  was  introduced  only  to  complete 
the  machine  description. 

Figure  3.8  shows  an  example  of  a  6  aircraft  formation,  with  the  aircraft  in  P4  and 
P5  having  broken  TX s.  When  the  aircraft  in  P2  loses  its  TW,  it  moves  to  position 
P7,  the  aircraft  in  P6  takes  its  position,  the  aircraft  in  P5  should  take  P6  if  this  was  a 
reconfiguration  after  a  real  aircraft  loss  but  the  Reconfiguration  Manager  knows  that 
the  aircraft  in  P7  is  going  to  re-enter  the  formation,  thus,  to  avoid  useless  position 
changes,  leaves  P6  free  and  drives  the  aircraft  in  P7  to  move  to  P6. 
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Figure  3.9:  RX  Failure  Management  Logic 

3.4.2  Receiver  (RX)  Failure 

After  an  aircraft  detects  a  failure  in  its  RX  device,  it  either  switches  to  use  the  V L 
trajectory,  or  it  must  leave  the  formation.  As  explained  before,  an  aircraft  with  a 
faulty  RX  but  with  a  virtual  connection  to  the  VL  can  lead  the  formation  without 
affecting  general  performance.  Thus,  if  the  current  leader  has  an  operational  RX, 
the  two  aircraft  can  change  their  position.  First  the  leader  moves  to  P7,  the  faulty 
aircraft  takes  PI,  then  the  leader  re-enters  the  formation  in  the  place  left  free  by 
the  other.  All  other  aircraft  hold  their  positions  during  this  phase.  The  finite  state 
machine  in  Figure  3.9  describes  this  logic. 

The  leader,  before  moving  to  P7  switches  its  TX  off  to  avoid  being  followed  by 
other  aircraft.  It  will  switch  it  on  again  after  being  in  its  new  position  inside  the 
formation  and  back  to  the  “Normal”  state.  The  faulty  aircraft,  before  moving  to  PI, 
switches  its  TX  off  for  the  same  reason.  It  will  turn  it  on  again  when  has  started  to 
lead  the  formation. 
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Figure  3. 10:  Example  of  Reconfiguration  after  RX  Failure 

Figure  3.10  shows  an  example  with  a  6  aircraft  formation.  When  the  aircraft  in 
P3  loses  RX  capability,  the  leader  moves  to  P7,  the  aircraft  in  P3  moves  to  PI,  then 
the  former  leader  takes  P3  and  reconfiguration  is  ended.  In  this  case  the  formation 
keeping  capability  is  unaltered  and  the  communication  optimal  solution  is  the  same  as 
before  failure.  Note  that  in  the  case  of  a  second  RX  failure  (as  shown  in  Figure  3.9), 
the  faulty  aircraft  remains  in  the  same  position,  if  connected  to  the  VL,  otherwise  it 
must  exit  the  formation. 

3.4.3  Example:  Failure  Management  during  Aircraft  Loss 

As  an  example  of  formation  management  procedure,  we  consider  the  case  of  loss  of 
aircraft  in  a  6-ship  formation.  As  shown  in  Figure  ??,  the  manager  is  present  in  each 
aircraft  and  handles  the  commands  to  the  autopilots  based  on  the  information  re¬ 
ceived,  transmitted,  and  communications  from  the  broadcast  channel.  The  schematic 
structure  is  shown  in  Figure  3.11. 

The  status  of  the  aircraft  is  processed  by  two  Finite  State  Machines  (FSM)  defined 
as  control’s  panel,  and  fault’s  manager.  The  control’s  panel  has  three  parallel  super¬ 
states  (Receiver,  Transmitter,  Aircraft_Status),  it  contains  four  events  (one  local 
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Figure  3.11:  Simulink  Diagram  of  Formation  Manager 
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Figure  3.12:  Control’s  Panel  Diagram 

and  three  as  input),  and  has  six  datasets  (two  inputs  and  four  outputs).  Figure  3.12 
shows  the  stateflow©  implementation  of  the  parts  of  Figures  3.7  and  3.9  relative  to 
the  control’s  panel  FSM. 

Let  us  describe  now  the  working  procedure  of  the  formation’s  manager  during  the 
loss  of  aircraft  3  in  a  formation  of  six,  -with  aircraft  5  replacing  it.  Figure  3.14  shows 
the  graph  flow  with  node  potentials  and  arc  weights  values,  in  the  nominal  situation. 

The  fault’s  manager  FSM  has  a  single  superstate  containing  seven  mutually  exclus¬ 
ive  states  (Nothing_ Happens,  Lost_Aircra£t,  My_RX_Faulty,  Leader,  RM,  My_TX_Faulty, 
TX_Faulty).  The  stateflow  representation  is  shown  in  Figure  3.13.  When  aircraft 
3  is  lost,  each  vehicle  runs  the  algorithm  again  setting  to  infinity  the  weights  of  the 
arcs  entering  and  exiting  node  3.  The  result  is  shown  in  Figure  3.15. 

As  far  as  aircraft  3  is  concerned,  its  control’s  panel  activates  the  state  Air- 


Figure  3.13:  Fault’s  Manager  Diagram 


Figure  3.14:  Minimum  Cost  Graph  from  Dijkstra’s  Algorithm,  Nominal 
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Figure  3.15:  Minimum  Cost  Graph  from  Dijkstra’s  Algorithm,  ignoring  Node  3 

craft_Status_Lost  and  the  value  of  1  is  assigned  to  the  output  variable  L.A  (Lost  air¬ 
craft).  The  latter  causes  the  event  Pos_A3  in  all  the  other  aircraft  fault’s  managers, 
via  the  broadcast  receivers,  in  addition  of  activating  Dijkstra’s  algorithm.  Event 
Pos_A3  forces  the  transition  from  state  Nothing  Happens  to  state  Lost  Aircraft  in 
the  Fault’s  Manager  of  aircraft  3,  since  L.A.=  =1  (see  Figure  3.16). 

The  other  aircraft  in  the  formation,  receive  event  Pos_A3,  and  execute  the  recon¬ 
figuration  maps,  going  to  state  RM  (see  top  right  block  in  Figure  3.17).  The  Fault’s 
Manager  in  aircraft  5,  in  particular,  evaluates  the  function  Reconfiguration_Map  ob¬ 
taining  the  value  3  as  new  desired  position  in  the  formation,  the  transition  is  valid 
and  the  state  RM  is  activated  (see  Figure  3.17).  Aircraft  5  understands  that  it  must 
change  position  to  node  3,  shuts  down  the  TX  (see  top  left  block  in  Figure  3.18), 
waits  for  the  others  to  perform  channel  reconfiguration  (Switch  OFF  ACK),  and 
then  executes  the  maneuver  to  go  to  the  final  destination.  In  this  case,  two  types  of 
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Figure  3.16:  Fault’s  Manager  Aircraft  3  after  its  Loss 


Figure  3.17:  Fault’s  Manager  Aircraft  5  after  Loss  of  Aircraft  3 
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Figure  3.18:  RM  Aircraft  5  TX  Shutdown 


maneuvers  are  available  as  shown  in  Figure  3.18,  Maneuverl  and  Maneuver2.  The 
former  is  achieved  with  a  change  in  altitude,  the  latter  without.  The  choice  is  based 
on  safety  reasons.  The  complete  sequence  is  described  then  by  the  sequence  of  Figures 
3.17,  3.18  and  3.19. 

When  aircraft  5  has  decided  to  move  to  Node  3,  the  shutdown  of  its  TX  activates 
Dijkstra’s  algorithm,  setting  the  weight  to  infinity  for  the  arcs  leaving  Node  5  (this 
avoids  other  aircraft  to  follow  5  during  the  reconfiguration  maneuver).  The  result  is 
shown  in  Figure  3.20.  The  new  optimal  graph,  with  aircraft  5  in  the  new  position  is 
computed,  as  in  Figure  3.21. 
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Figure  3.19:  RM  Aircraft  5  TX  Maneuver  to  Node  3 
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Figure  3.20:  Minimum  Cost  Graph  ignoring  Node  3,  and  all  Arcs  exiting  Node  5 
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Part  II 

Guidance  and  Management  of 
Flight  Vehicles 
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Chapter  4 


Stability  of  Gain  Scheduling  using 
Fuzzy  Sets 

4.1  Introduction 

This  chapter  and  the  next  describe  the  research  performed  in  the  area  of  stability  and 
guidance  of  autonomous  flight  vehicle  formation. 

Since  its  first  appearance,  Takagi-Sugeno  (TS)  fuzzy  model  theory  [Takagi,  1985] 
has  proven  useful  in  the  description  of  nonlinear  dynamic  systems  as  a  means  of 
blending  of  models  obtained  by  local  analysis.  Such  descriptions  are  referred  to  as 
model  based  fuzzy  systems  (MBFS).  In  addition,  the  TS  approach  can  be  used  for 
the  synthesis  of  fuzzy  gain-scheduled  controllers.  The  stability  of  MBFS  was  stud¬ 
ied  by  Hallendorn,  Palm  and  Driankov\cite  [Hallendorn,  1996a],  [Hallendorn,  1996b], 
who  defined  a  stability  test  by  imposing  some  conditions  on  the  local  control  laws. 
The  present  work  describes  a  new  stability  criterion,  which  relaxes  the  bounds  in 
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[Hallendorn,  1996b],  yielding  a  less  conservative  condition.  Two  case  studies  are 
presented  comparing  the  use  of  off-equilibrium  versus  equilibrium  grid  points,  and 
fuzzy  versus  crisp  scheduling. 


4.2  Modeling  and  Control 

Consider  a  nonlinear  continuous  and  continuously  differentiable  system  of  the  form: 


x  =  f(x,  u)  (4.1) 

wherex  E  5ftn,  u  E  5ftm,  and  5ftn  x  5ftm  — >  9?n.  We  wish  to  design  a  controller  capable  of 
following  some  desired  trajectory  ,  where  xr  is  a  differentiable,  slowly  varying  state 
trajectory,  and  ur  is  the  nominal  input  necessary  to  follow  the  unperturbed  xr  state2,3. 
Let  us  define  a  subset  XU  C  5ftn+Tn  of  the  system’s  state  and  input  spaces  as  a  bound 
on  all  the  possible  state  and  input  values.  Let  us  also  define  a  set  of  operating  points 
as  (xi,Ui)  E  XU,  i  E  I  with  I  set  of  all  positive  integers  that  form  a  regular  (or 
irregular)  grid  J  in  the  trajectory  space.  Linearization  of  Eq.  (4.1)  about  all  the 
points  in  J  yields: 


A-  -  ^1 

^  —  dxl  (Xi,Ui) 

B  =  SL\ 

1  du  I  (xi,Ui) 

resulting  in  perturbed  dynamics  about  the  linearization  points  given  by: 


(4.2) 


x  =  Ai  (x  -  Xi)  +  Bi(u-  Ui )  +  / (x i, Ui )  =  AiX  +  BiU  +  di 


(4.3) 


di  =  /  ( xi ,  Hi)  -  AiXi  -  BiUi 

When  the  linearized  systems  (4.3)  are  interpolated  through  a  TS  model,  a  non¬ 
linear  approximation  of  (4.1)  is  obtained,  given  by: 
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Figure  4.1:  Example  of  Fuzzy  Rule  Set 


x  =  /  (x,  u)  =  ^2  Vi  (£, u)  •  ( +  BiU  +  di )  (4.4) 

i€l 

A  fuzzy  control  law  for  system  (4.4)  is  also  designed  as  a  gain-scheduling  controller 
based  on  a  TS  model.  Under  the  hypothesis  of  controllability  for  all  system  matrices 
pairs  and  being  all  the  states  measured,  full  state  feedback  linear  control  laws  can  be 
synthesized,  and  interpolated  through  a  fuzzy  TS  system  yielding: 

U  =  Ur  +  (5 ,  u)  ■  K.  [(5  -  Xj)  -  (xr -Xj)} 

=  ur  +  fi)  •  Kj 

In  Eqs.  (4.4)  and  (4.5),  the  expressions  represent  the  TS  linear  membership 
functions  relating  the  input  variables  to  the  fuzzy  domain  described  by  IF-THEN- 
ELSE  rules  consequent.  The  fuzzy  system  membership  functions  are  chosen  such  as 
they  constitute  a  convex  sum  over  the  input  range  XU.  An  example  is  shown  in 
Figure  4.1 

Substituting  Eq.  (4.5)  in  Eq.  (4.4),  the  closed  loop  perturbed  system  dynamics 


77 


become: 


x  -  XT  =  Yj  Vi  {x,  u) 


A  +  Bt  I  X)  Vj  (x,  u)  Kj 


(x  -  xr)  4-  £ 


(4.6) 


e  =  Vi  (x> u ) '  (AiXr+BiUr+di)  -x, 


(4.7) 


Note  that  the  term  ^  A{Xr  is  added  and  subtracted  so  that  the  matrix 

i 


^2  Hi  (x,u) 


A  i  + 


fli  (!>(*•  s>^) 


(4.8) 


i  L  Vi  /  J 

gives  the  dynamics  of  the  perturbation  from  the  desired  trajectory.  Also,  from  the 
definition  of  di,  e  represents  the  error  with  respect  to  due  to  the  approximation  of 
/  with  the  TS  model. 


4.3  Stability  Analysis 

Let  us  now  derive  the  asymptotic  stability  conditions  of  the  TS  fuzzy  gain-scheduling 
controller  around  (xr,ur)  . 

Definition:  Given  the  grid  point  set  J  and  any  linearized  dynamics  ( Ai,B{ ) ,  i  £ 
J,Ji  is  defined  as  the  set  of  all  indexes  m  of  the  neighbourhood  points  of  {xi 
whose  controllers  Km  have  a  non  negligible  influence  over(Au  Bt) . 

>From  the  above,  J,  contains  all  points  m  such  that  vm  (x,  u)  >  0,  V  (x,  u)  G 
{(5,fi)  :  pi  (x,u)  >  0}. 

Given  a  generic  input  state  pair  (xi,ui),l  /,  the  stability  property  for  the 
tracking  error  (:/,';  —  xT)  — >  0  requires  that  the  following  conditions  be  satisfied: 
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Condition  1:  Suppose  (xi,Ui)  E  J  is  the  nearest  linearization  grid  point  to  the 
operating  point  (x^Ui)  E  J.  The  system  remains  closed-loop  stable  using  a 

convex  combination  of  controllers  Km,m  E  J*. 

Condition  1  is  verified  using  the  following  test,  which  is  based  on  differential  inclu¬ 
sion  theory  [Boyd,  1994],  [Marullo,  2001]  the  test  guarantees  that  the  TS  modelling  of 
the  plant  A  /  (•)  is  stable  when  controlled  by  the  TS  fuzzy  controller  for  all  possible 
controller  combinations.  Consider  the  closed-loop  system  dynamics  about  ( x^Ui ): 


Ai  +  Bi  vj  (x,  u)  K^j  x 
=  V  Vj  (X,  u)  ■  [Ai  +  BiKj]  X 


(4.9) 

(4.10) 


3 

obtained  by  a  convex  combination  of  controllers/^,  m  €  J{. 

Equation  (4.9)  has  the  form  of  a  polytopic  differential  inclusion,  where  the  vertices 
are  the  matrices  At  +  BiKj,i  G  ^.Differential  inclusion  theory  states  that  closed-loop 
stability  for  the  vertices  of  a  polytope  yields  stability  of  the  whole  convex  combination, 
therefore  stability  of  all  A{  +  BxKhi  e  J.is  required.  The  stability  test  is  repeated  for 
all  grid  points  obtaining: 


Vi  €  I,  V?  €  Ji,  3 Pi  >  0  :  (Ai  +  B{Kj)T  Pi  +  Pi  (Ai  +  BiKj )  <  0  (4-11) 

Inequality  (4.11)  can  be  easily  solved  using  Linear  Matrix  Inequalities  (LMI) 
techniques.  If  the  LMI  test  fails,  then  the  grid  J  must  be  made  denser.  Further¬ 
more,  the  LMI  test  suggests  where  to  add  additional  linearization  points,  in  order 
to  make  the  closed-loop  system  stable.  The  proposed  stability  test  improves  that  of 
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[Khargonekar,  1987];  since  it  does  not  require  that  the  closed  loop  eigenvalues  be  the 
same  for  all  operating  points  i  e  I  ([Khargonekar,  1987],  Equation  (23)). 

Condition  2:  The  approximation  error  due  to  linearization  and  successive  TS 
fuzzy  modelling  with  respect  to  the  original  nonlinear  system  is  small  enough  as  not 
to  compromise  robust  stability  with  respect  to  structured  uncertainties. 

Let  us  suppose  that  the  desired  closed-loop  dynamics  are  given  by: 

Ad  =  Ai  +  BiKi,VieI  (4.12) 

then,  from  Eq.  (4.9): 

Y  Vj  ( x ,  u )  •  [Ai  +  BiKj]  x  =  Ad+  Y  vj  (*> «)  SAij  (4-13) 

j  3 

with: 

SAij  =  B  ( X{ ,  Ui)  [K  (xj,  Uj )  -  K  ( Xi ,  Ui))  (4.14) 

[Hallendom,  1996a],  [Marullo,  2001]  propose  to  test  the  stability  of 

A  +  fii  (x,  u)  Vj  (x,  u)  • SA^  (4-15) 

i  j 

using  the  robust  stability  theorem  under  structured  uncertainties  found  in  [Khargonekar,  1987] . 
In  order  to  satisfy  Condition  2,  the  uncertainty  in  the  systems  (Ai:  Bi)  due  to  linear¬ 
ization  errors  is  modeled  by  a  set  of  possible  parametric  uncertainties.  The  maximum 
parametric  variations  for  which  stability  is  guaranteed  can  be  computed  using  LMI 
techniques.  If  this  result  is  larger  than  the  maximum  functional  error,  then  the  sys¬ 
tem  remains  stable  in  the  entire  convex  combination  of  grid  J  points.  The  functional 
approximation  error  due  to  linearization  is  computed  as  follows  [Johansen,  1993]: 
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M 


<-[A  (J,XU)Y  =  e 


I 

where  e  is  the  maximum  approximation  error,  and 


(4.16) 


l|V2/(^^)lloo  <M,\/(x,u)  EXU 
A  (A,  B )  =  inf  sup  || a  -  b\\2 


(4.17) 


aeA 


beB 


The  term  A(J,XU)  represents  a  measure  of  the  inverse  grid  point’s  density:  a 
small  A  implies  a  dense  grid.  In  fact,  the  particular  choice  for  M  gives  a  conservative 
estimate  for  e.  Some  regions  of  XU  may  be  more  “regular”,  thus  requiring  a  sparse 
grid.  A  local  value  el  for  the  error  can  be  defined  as: 


^  [A  ( Ju  conv  ((xk,  uk)  ,ke  J*))]2  = 


(4.18) 


l|V7(S,«)|L  <  Mi,  V  (x,  u)  E  conv  ((xk,uk) ,  k  e  Ji )  (4.19) 

where  conv{.)  indicates  convex  closure.  Grid  density  can  be  adapted  depending 
on  the  variousMi,  to  keep  below  the  desired  approximation  error  e.  To  test  the 
robustness  of  the  control  system,  let  us  define  a  set  of  structured  uncertainties  Eiim 
as  matrices  with  1  in  the  (l,  m)  position  and  zero  otherwise.  Define  also  the  finite  set: 

Mji  =  {(J,m)  :  (A  *  +  ±  0,  j  6  Jt)  (4.20) 

and  an  index  p  to  the  elements  in  the  set  Mji.  A  matrix  El:m  exists  for  each  element  p 
in  Mji, Thus,  the  generic  structured  uncertainty  can  be  modeled  as  Ep  =  kpEitm  where 
the  scalar  kp  is  the  magnitude  of  uncertainty,  and  p  the  index  in  Mji  corresponding 
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to  the  given  pair  ( l,m ).  Note  that  a  matrix  EiiTn  exists  for  each  element  in  Mji.  We 
can  then  solve  the  following  LMI  problem  in  the  unknowns  Pi  and  kp: 


/ 


Pi 


=  ma  xEi=f' 


l*rl 


Vi.Vj  eJil 


Pi  >o 

(A,  +  BiKjf  Pi  +  Pi  ( Ai  +  BiKj)  + 


(4.21) 


[  +  (u?1  Epy  pt + Pi  (Ei=f 1  ep)  <  o 

yielding  the  bound  to  the  maximum  allowable  uncertainty. 

If  pi  >  Si ,  Vi,  then  system  (4.1)  with  the  fuzzy  gain-scheduling  controller  given 
by  (4.5)  is  stable  for  all  trajectories  in  XU.  If  the  stability  test  fails,  it  is  necessary 
to  select  a  denser  grid.  The  values  of  pi  that  break  the  e,  threshold  indicate  which 
regions  in  XU  require  a  denser  grid. 

Suppose  now  that  (4.21)  yields  pi  <  £i,  we  must  find  a  new  approximation  er¬ 
ror  £[  such  that  p\  >  e\.  This  implies  that  M;  and  A  (•)  must  be  reduced  by 
increasing  the  number  of  grid  points.  The  additional  grid  points  must  belong  to 
conv  ((xfc,  Uk) ,  k  e  Ji).  The  new  grid  J'  satisfies  therefore  J'  D  J.  The  following  now 
holds: 


conv  (( xk ,  life)  ,k  6  J')  C  conv  ((xk,uk) ,  k  6  Ji)  (4.22) 

>From  (4.19)  we  have: 


M'^Mi 

A  ( J[,  conv  (( xk ,  uk)  ,k  e  J-))  <  A  ( Ji,  conv  (( xk ,  uk) ,  k  E  Ji)) 


(4.23) 


So  from  (4.18)  e\  <  e,.  LMI  optimization  is  run  again  over  J',  yielding  p\.  The 
procedure  is  repeated  until  Pi  >  >  Vi. 
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4.4  Case  Studies 


The  first  case  study  is  a  classical  nonlinear  system  benchmark.  Consider  the  system 
given  by: 


Xi  =  x2 

r.2  I  Ji 


(4.24) 


x2  =  xf  +  x$  +  u 


The  objective  of  the  control  design  is  to  follow  reference  trajectory  given  by  a  step 

1  T 


command  on  the  first  state,  i.e.  xr  = 


A  0 


.  A  pole  placement  method  is  used  to 


assign  the  closed-loop  linearized  spectrum  to  (-2.5,  -5.0).  Two  fuzzy  controllers  were 
designed: 

Conventional  controller  case:  this  controller  is  obtained  considering  equilib¬ 
rium  points  only.  The  equilibrium  points  for  (4.24)  belong  to  the  manifold 


{{xle,x2e,ue)\x2e  =  0, ue  =  -  (xle)2} 

from  which  the  following  were  selected:  [(0.5,0, -0.25),  (1.5, 0,-2. 25),  (2.5, 0,-6. 25), 
(3.5,0,-12.25)], 

Off-equilibrium  case:  the  following  linearization  points  were  selected:  [(0.5,- 
1,0),  (1.5, -1,0),  (2.5, 1,0),  (3.5, 1,0),  (0.5, 0,0), (1.5, 0,0),  (2.5, 0,0),  (3.5, 0,0),  (0.5, 1,0), 
(1.5, 1,0),  (2.5, 1,0),  (3.5, 1,0),  (0.5, 4,0),  (1.5, 4,0),  (2.5, 4,0),  (3.5, 4,0)].  Note  that  this 
set  contains  non-equilibrium  points  as  well. 

Figure  4.2  shows  the  controlled  system’s  response  to  a  step  of  amplitudes  3  and 
4. 


Figure  2:  Step  Response 


It  is  evident  from  the  time  histories  that  the  off-equilibrium  solution  outperforms 
the  conventional  one.  The  conventional  fuzzy  controller  can  not  track  the  command 
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Figure  4.2:  Step  Response 

with  amplitude  4,  while  the  off-equilibrium  fuzzy  controller  tracks  the  command  with 
fast  settling  time  and  little  overshoot.  Although  the  final  state  (4,0)  belongs  to 
the  stability  manifold,  the  conventional  controller  can  not  reach  it  in  response  to 
a  step  command  because  its  state  crosses  regions  where  x2  »  0, which  is  too  far 
from  the  equilibrium  manifold.  The  off-equilibrium  controller  succeeds  in  tracking 
the  command  because  it  was  designed  to  be  stable  in  a  larger  region  XU  containing 
all  the  state  trajectories.  From  Condition  1,  we  have  that  the  convex  combination  of 
fuzzy  controllers  in  the  intermediate  region  retains  stability. 

Robustness  to  approximation  error  is  also  satisfied.  In  the  calculation  of  course, 
the  structured  uncertainty  matrices  are  zeroed  for  the  dynamic  matrix  entries  re¬ 
lative  to  linear  functions  (in  such  a  case  even  if  the  Jacobian  matrix  entry  is  dif¬ 
ferent  from  zero,  the  approximation  error  results  null).  That  is  if  the  Xi  derivative 
were  nonlinear,  the  approximation  test  would  fail  suggesting  a  necessity  for  a  finer 
grid  (the  Johansen  index  in  the  proposed  example  depends  mainly  on  the  grid  step 
A  (Ji;  conv  ((xi,  Ui),i€  Ji ))). 
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Figure  4.3:  Schematic  of  a  Two-Ship  Formation 

The  second  case  study  is  a  formation  control  problem  for  unmanned  aircraft  ex¬ 
ecuting  tight  turns  as  depicted  in  Figure  4.3. 

The  dynamics  of  the  aircraft  are  based  on  a  standard  point  mass  model  with 
speed,  flight  path  angle,  and  heading  angle  as  states,  and  thrust,  bank  angle  and  load 
factor  as  inputs.  The  formation  error  is  computed  as  distances  of  leader  and  wing- 
man  from  the  formation  geometric  center  (FGC)  defined  in  [Blake,  W.,  2000],  where 
complete  modelling  and  autopilot  design  are  presented.  The  formation  controller  is 
limited  to  planar  motion  with  a  constant  speed  of  20  m/sec  [Giulietti,  F.  et  al,  2000], 
and  the  only  variation  on  the  heading  angle  x  £  (  —  this  implies  XU  = 

[  —  7r,7r]  X  [  — 7T,  7r] .  Nine  operating  points  were  used  to  form  the  grid,  and  for 
each  point  a  standard  LQ-Servo  was  designed  using  a  LMI  procedure4.  Perform¬ 
ance  comparison  was  made  between  TS  fuzzy  gain  scheduling,  and  a  crisp  schedule 
[Khargonekar,  1987],  [Nichols,  1993]. 

The  stability  test  described  in  the  previous  section  was  successful,  as  well  as  the 
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Figure  4.4:  Heading  Change  tracking 


test  for  the  approximation  error  (e  =  7.969,  A  =  n/S,  M  —  19.6).  A  comparison  was 
made  between  the  conventional  controller  (rigid  gain  scheduling  with  no  mixing  of 
gains),  and  the  fuzzy  gain-scheduled  system  (FGS).  The  validation  and  comparison 
was  performed  by  testing  for  a  sequence  of  tight  turns  for  which  the  crisp  scheduled 
controller  becomes  unstable  because  is  more  sensitive  to  high  frequency  changes  in 
the  scheduling,  while  the  fuzzy  one  does  not.  Results  of  the  performance  of  the  FGS 
are  shown  in  Figures  4.4  and  4.5. 

In  Figure  4.4  we  can  see  a  detailed  section  of  the  trajectory  indicating  the  closeness 
of  the  formation  and  the  position  of  the  aircraft  relative  to  the  FGC.  Figure  4.5  shows 
the  behaviour  of  the  X-Y  distances  with  respect  to  the  formation  geometry  center, 
with  the  nominal  (desired)  values  set  at  5  meters  for  each  component. 
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Figure  4.5:  Horizontal  Distances  to  FGC 


Chapter  5 


A  Guidance  Methodology  using 
Fuzzy  Sets  and  Waypoints 
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Chapter  6 


Fuzzy  Guidance 

6.1  Introduction 

This  section  describes  the  development,  the  simulations  and  the  first  results  achieved 
of  an  innovative  guidance  scheme  based  on  fuzzy  systems.  The  aim  of  such  a  guidance 
system  is  having  a  tool  for  easy  guidance  of  a  single  vehicle,  groups  or  formations 
through  a  set  of  waypoints  generated  by  a  mission  planning  algorithm. 

The  guidance  system  requirements  are: 

1.  capability  to  pass  a  set  of  waypoints  in  the  prescribed  order. 

2.  Possibility  to  specify  the  desired  crossing  velocity  and  heading  for  each  waypo¬ 
int. 

3.  To  handle  waypoints  set  where  successive  waypoints  may  not  necessarily  be  on 
directly  flyable  routes  (e.g.  two  waypoints  one  above  the  other). 

4.  Capability  to  reconfigure  quickly  the  waypoint  set  without  delay;  possibly  in 
response  to  some  change  in  the  mission  scenario. 
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5.  To  reach  fixed  waypoints  as  well  as  to  track  and  reach  waypoints  that  are  moving 
with  relatively  low  speed  and  acceleration. 

The  Fuzzy  Guidance  System  (FGS)  assumes  that  the  vehicle  knows  its  position 
and  targets/waypoints  position  as  well  as  their  velocity  vector,  in  the  case  they  are 
moving. 

In  generic  waypoints  are  described  in  a  5-dimensional  space:  position  in  3-dimensions 
plus  desired  crossing  heading  and  velocity.  In  the  case  of  waypoints  that  model  mov¬ 
ing  targets,  the  desired  crossing  velocity  is  meant  as  relative  velocity  between  the 
vehicle  and  the  target  . 

For  guidance  study,  the  generic  aircraft  is  assumed  to  be  autopiloted  in  velocity, 
heading  and  flight  path  angle.  The  FGS  is  based  on  various  standard  Takagi-Sugeno 
(T-S)  [Takagi,  1985]  fuzzy  controllers  that  generate  separately  velocity,  heading  and 
flight  path  angle  references  for  the  autopilots.  The  choice  of  the  fuzzy  systems  arises 
from  the  need  to  specify  desired  waypoint’s  crossing  direction,  since  traditional  pro¬ 
portional  guidance  [K.  R.  Lee  and  Al.,  2000]  techniques  do  not  allow  specifying  it. 
T-S,  among  others  motivations,  have  been  chosen  because  parts  of  the  control  al¬ 
gorithms  need  to  perform  surface  approximation  that  must  be  fast  from  a  computa¬ 
tional  standpoint. 


6.2  Aircraft  Dynamics  and  Control 

The  aircraft  guidance  problem  is  addressed,  by  designing  an  inner  nonlinear  control 
loop  first,  which  allows  tracking  of  commanded  velocity  (V^),  flight  path  (7^)  and 
heading  (xrf)-  Then,  an  outer  loop,  that  is  the  actual  fuzzy  guidance  system  (FGS), 
generates  a  reference  path  command  in  terms  of  desired  velocity,  flight  path  and 
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heading  for  the  inner  loop,  in  order  to  reach  the  desired  waypoint. 


6.2.1  Aircraft  Dynamics 

For  the  purpose  of  our  study,  a  mathematical  model  of  the  aircraft  was  developed 
following  some  basic  assumptions: 

•  Flat,  non  rotating  earth. 

•  Standard  atmosphere,  no  wind  effects. 

•  There  are  no  side-slip  forces  and  the  j3  angle  is  always  zero. 


•  The  aircraft’s  movements  around  its  center  of  mass  (attitude)  can  be  neglected. 

Under  these  assumptions  a  three  degrees-of-freedom  point-mass  mathematical 
model  is  used.  The  model  consists  of  three  first  order  non-linear  differential  equations, 
in  spherical  coordinates: 

V  =  —  g  sin  7  (6.1) 

m 

i  =  y  (n  COS  4>  —  C0S7)  (6-2) 

=  gnsuufr  (6.3) 

The  state  variables  that  describe  the  aircraft  motion  are:  airspeed  (V),  flight  path 
angle  (7)  and  heading  angle  (y),  and  the  input  variables  are  thrust  (T),  load  factor 
(n)  and  bank  angle  (<^),  further  model  parameters  are  the  aerodynamic  drag  (D)  and 
the  aircraft  weight  (W). 

The  complete  aircraft  dynamics  are  summarized  as 


x  =  h(x ,  u) 


where  x  =  [V,  7,  y]  and  u  =  [T,  n,  <fi] . 
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6.2.2  Aircraft  Control  System 

Assuming  perfect  modeling,  the  aircraft  dynamics  as  in  equation  (6.4)  can  be  feedback 
linearized  with  the  following  control  laws: 

T  =  kv(Vd  —  V)m  +  mg  sin  7  +  D  (6.5) 

]/ 

n  cos  <fi  =  —  [kj  (' yd  —  7)  +  cos  7]  =  c\  (6.6) 

V 

n sin  ^>  =  —kx  (xd  —  x)  cos  7  =  c2  (6.7) 

from  (6.6)  and  (6.7)  n  and  0  are  given  by: 

n  =  yjc\2  +  c22  (6.8) 

and 

4>  =  tan-1  (6-9) 

with  Ky,  K-,  and  Kx  positive  constants,  and  Vd,  and  Xd  the  desired  state  traject¬ 
ories. 

The  resulting  linear  system  is: 

'  V  =  Kv  (Vd  -  V) 

<  7  =  (7d  -  7)  (6.10) 

k  X  =  Kx(xd~  X) 

Thus,  a  complete  state  variable  decoupling  can  be  achieved.  In  the  case  of  inexact 
modeling,  decoupling  and  Unear  behavior  is  no  more  guaranteed. 
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6.3  Fuzzy  Guidance 

The  design  of  the  FGS  had  various  revisions  that  can  be  summarized  in  three  FGS 
that  are  succesive  in  time  and  increasing  in  performances  and  features  respect  to 
guidance  requirements.  The  first  FGS  accomplishes  the  first  four  requirements  (1  to 
4)  but  is  not  capable  to  track  moving  waypoints.  In  the  second  FGS,  the  structure  of 
horizontal  guidance  changes  greatly,  two  controllers  are  employed  for  short  and  long 
distance  guidance;  the  performances  of  the  first  one  are  improved,  some  singularities 
in  the  control  law  are  removed  and  the  number  of  fuzzy  rules  is  reduced.  The  third 
FGS  achieves  the  5th  requirement:  the  capability  to  follow  a  moving  waypoint  and 
cross  it  with  the  desired  crossing  heading  and  relative  velocity. 

6.3.1  First  FGS  Design 

Two  components  constitute  the  guidance  system:  the  Waypoint  Generator  (WG) 
and  the  Fuzzy  Guidance  System  (FGS).  The  desired  trajectory  is  specified  in  terms 
of  a  list  of  waypoints  without  any  requirement  on  the  path  between  two  successive 
waypoints.  A  waypoint  is  given  in  cartesian-space  coordinates  (Xw,  Vw,  Hw)  and  a 
desired  crossing  speed  (Vw)  and  heading  angle  (xw )  are  used  to  obtain  a  preferred 
approaching  direction  and  velocity,  thus  the  waypoint  belongs  to  a  five-dimensional 
space  W  =  [Xw,Yw,  Hw,  Vw,  Xw]-  The  WG  holds  a  list  of  waypoints  (WL)  in  5-D, 
checks  aircraft  position,  and  updates  the  desired  waypoint  when  the  previous  one  has 
been  reached  within  a  given  tolerance.  When  all  waypoints  have  been  reached,  it 
holds  the  last  one  so  that  the  aircraft  loops  around  it.  Otherwise  it  could  be  possible 
to  select  the  starting  point  as  the  last  waypoint.  The  waypoint  generator’s  only  task 
is  to  present  the  actual  waypoint  to  the  FGS.  At  this  point  of  this  research,  no  dead- 
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reckoning  or  navigational  errors  are  modeled  so  the  WG  and  the  FGS  know  the  exact 
aircraft  positions,  velocity  and  heading. 

Between  the  WG  and  the  FGS,  a  coordinate  rotation  system  transforms  earth- 
fixed-frame  position  errors  into  waypoint-frame  relative  errors.  Each  waypoint  defines 
a  coordinate  frame  centered  in  the  waypoint  position  (Xw,  Fw?  Hw)  and  rotated  by 
Xw  around  the  H-axis.  This  coordinate  transformation  allows  to  synthesize  a  fuzzy 
rule-set  valid  in  the  waypoint-fixed  coordinated  frame  that  is  invariant  with  respect 
to  the  desired  approach  direction  xw  •  When  a  waypoint  is  reached,  the  next  one  is 
selected,  the  actual  reference  value  W  is  changed  and  the  rotation  matrix  is  updated 
to  transform  position  and  orientation  errors  into  the  new  waypoint  coordinate  frame. 

As  described  above,  the  aircraft  autopilots  are  designed  to  track  desired  airspeed 
(Va),  heading  (xa)  and  flight  path  angle  (7 d). 

Using  the  completed  decoupled  implementation  of  guidance  laws,  three  independ¬ 
ent  Takagi-Sugeno  Fuzzy  Controller  have  been  designed  to  constitute  the  FGS. 

One  FC  generates  the  desired  flight  path  angle  (7a)  for  the  autopilot  using  altitude 
error  eH  =  (Hw  —  H): 

Id  —  /7(eir)  (6*11) 

The  second  fuzzy  controller  computes  desired  aircraft  velocity: 

Fa  =  Uw  +  fv(Vw  -V)  =  VW  +  fv(ev)  (6.12) 

The  third,  and  most  complex  FC  is  demanded  to  generate  the  desired  heading 
angle  ( Xd )  using  the  position  errors  along  the  X  and  Y  axis  of  the  actual  waypoint- 
frame  (e^c,  eyc),  and  heading  error  ex.  Fuzzy  rule-set  is  designed  at  a  fixed  airspeed 
value,  this  fact  can  produce  a  lack  of  tracking  performances  when  the  desired  way- 
point  crossing-speed  Vw  differs  significantly  from  tune-up  value.  The  solution  to  this 
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problem  is  achieved  by  introducing  a  speed-correlated  scale  coefficient  to  position 


=  Rot(xw) 


=  Rot(xw ) 


X]y  —  X 

Vw-r 


(6.13) 


be  position  errors  in  the  fixed  waypoint  coordinates  frame,  (e%c,eyc)  is  the 
velocity-compensated  position  errors  defined  by: 


=  S(VW)V*) 


S(  Vw,V*)  =  — 


(6.14) 


(6.15) 


Where  V*  represents  the  airspeed  value  used  during  FGS  membership  rules  design.  In 
this  way,  position  errors,  used  by  the  FGS  to  guide  aircraft  toward  WP  with  desired 
approaching  direction,  result  to  be  magnified  when  Vw  (requested  waypoint  crossing- 
speed)  is  larger  than  V*  or  reduced  otherwise.  The  equation  6.15  may  diverge  if  Vw 
goes  to  zero,  however  this  is  a  non-operative  condition  because  the  requested  waypoint 
crossing-speed  should  be  defined  accordingly  to  aircraft  flight  parameters.  Definition 
of  parameter  S  denotes  a  new  degree  of  freedom  in  FGS  tuning  process  and  may  also 
be  defined  using  a  non-linear  function  of  (V* ,  Vw)  provided  that  S(Vw,  V*)  =  1  when 
Vw  =  V*.  Afterwards  the  desired  heading  angle  produced  by  FC  is  defined  by: 


Xd  =  Xw  +  fx(eXC’eYc ’  ex) 


(6.16) 


Figure  6.1  shows  the  complete  fuzzy  guidance  and  control  scheme. 
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Figure  6.1:  The  First  FGS  Schematic 


6.3.2  Takagi-Sugeno  Fuzzy  Controller  Concepts 

FGS  is  based  on  Takagi-Sugeno  fuzzy  systems[Takagi,  1985]  model  described  by  a 
blending  of  fuzzy  IF-THEN  rules: 

IF  x i  IS  F,1  AND  x2  IS  F\  AND  •  ■  • 

•  •  •  AND  xn  IS  Fl  THEN  y  IS  G] 

IF  xi  IS  F2  AND  x2  IS  F2  AND  ■  ■  ■ 

■  ■  ■  AND  xn  IS  F2  THEN  y  IS  G2y  (6.17) 

IF  X !  IS  F™  AND  x2  IS  F2m  AND  ■  ■  ■ 

■  •  •  AND  xn  IS  F™  THEN  y  IS  G™ 

where  (a:i,  -  -  ■  ,xn)  is  the  fuzzy  controller  (FC)  input  vector,  Fj  are  fuzzy  sets  and 
y  is  the  FC  output.  Using  a  weighted  average  defuzzifier  layer  each  FC  output  should 


96 


be  defined  as  follows: 


^2fii(x)Ui 

y  =  -  (6-18) 

k= 1 

where  /i;(x)  is  the  ith  membership  function  of  input  x  to  ith  fuzzy  zones. 

6.3.3  Fuzzy  Guidance  Laws  Design 

The  fuzzy  rules  have  been  defined  according  to  the  desired  approaching  behavior 
and  angular  rates  limitations  of  the  aircraft.  Fuzzy  knowledge  base  was  designed 
to  generate  flyable  trajectories  using  the  maximum  linear  and  angular  velocities  and 
accelerations  that  are  typical  of  a  small  propeller-engine  aircraft.  The  BLUESNIPE 
research  aircraft  characteristicswere  taken  as  a  reference  [Giulietti,  F.  et  al,  2000]. 
Anyhow,  the  laws  can  be  easily  adapted  to  the  performances  of  any  other  aircraft  and 
this  implies  varying  the  membership  functions  dimensions  only.  The  FGS  provides 
with  different  desired  flight  path  and  heading  angle  commands  for  different  values  of 
distance  from  the  waypoint. 

Deriving  from  the  complete  uncoupled  aircraft  model  it  is  possible  to  describe 
each  fuzzy  controller  separately  from  the  others.  The  Altitude  controller  and  the 
Velocity  FC  are  less  complex  than  Heading  controller,  they  are  both  implemented 
using  Takagi-Sugeno  model;  for  the  first  one  the  only  input  is  the  altitude  error 
Cjj  =  ( // w  —  H)  and  four  fuzzy  set  are  designed  to  map  this  input  and  four  for  the 
Jd  output: 

•  If  eH  Is  Noo  Then  Is  P2o:  for  big  negative  errors. 

•  If  eH  Is  N„  Then  Is  Pi'-  for  small  negative  errors. 
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•  If  (’11  Is  Ps  Then  7 d  Is  A/^:  for  small  positive  errors. 


•  If  eii  Is  Poo  Then  7^  Is  N20:  for  big  positive  errors. 

The  Velocity  FC  has  similar  complexity  as  the  Altitude  controller:  3  input  fuzzy 
sets  for  ey  velocity  error  and  3  for  the  resulting  AVj  output: 

•  If  ey  Is  Nx  Then  AV'(;  Is  Pi0:  for  negative  errors. 

•  If  ey  Is  ZE  Then  AVd  Is  ZE:  for  near  to  zero  errors. 

•  If  ey  Is  Poo  Then  AVd  Is  AT10:  for  positive  errors. 

In  fact,  we  assumed  the  vehicle  to  be  autopiloted  in  velocity,  so  this  controller 

could  be  avoided  but  its  usefulness  lies  in  its  nonlinear  characteristic  that  acts  as  gain 
varying  with  error  itself. 

As  stated  before  guidance  in  the  horizontal  {X  —  Y)  plane  is  more  complex  than 
guidance  in  the  vertical  ( X  —  H)  plane.  The  horizontal  plane  fuzzy  controller  takes 
his  input  from  scaled  position  errors  (e^c,  eyc)  and  heading  error  (ex).  (e^c)  error  is 
coded  into  five  gaussian  fuzzy  sets: 

•  Noe,:  for  big  negative  errors. 

•  Ns:  for  small  negative  errors. 

•  ZE:  for  near  to  zero  errors. 

•  Ps:  for  small  positive  errors. 

•  Pqo :  for  big  positive  errors. 
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three  sets  are  also  defined  for  ( eyc )  (Yw  axes  error):  ( NS,ZE,PS ).  Considering 
the  Takagi-Sugeno  output  function  for  this  fuzzy  controller: 


y^jii(x)ui 


i— 1 

y  m 


k= i 


S  K 


where: 


'  '  1=1  j—  1 

m 

c(x)  = 

A:=l 


(6.19) 


(6.20) 


lhV(e'xc'eYc)  =  P?(eXc)  '  $(eYc) 

S  is  the  number  of  zones  dividing  the  flight  space  and  K  is  the  number  of  subsets 
(dependent  from  ex)  defined  for  each  zone.  Equation  (6.19)  can  be  simplified: 

5  nxy(pw  pw  ^  _  S _ 

E-  = yjz’^xc^c)  -^(o  (6-2i> 

'  t=l 

Fixing  (e^c,e^c)  in  the  middle  of  Pth  zone,  under  the  assumption  that  the  contri¬ 
bution  from  the  other  zones  is  near  to  zero: 


yP 

—  77*2/  (  pw 

w 

eyP 

Yc 

+  Es’(' 

i—  1 
i^P 

—  Tixy  (  pw 

—  fiP  \  eXP 

C  1C 


(6.22) 
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W 


Equation  (6.22)  shows  that  the  definition  of  fuzzy  sets  for  (ex)  error  should  be 
computed  looking  at  each  single  set  partitioning  the  flight  space  and  then  looking  at 
the  cumulative  result.  Under  this  assumption,  seven  fuzzy  sets  have  been  defined: 

•  Nb  and  Pb-  used  to  keep  output  to  ±7r  when  big  negative  or  positive  errors. 

•  Nm  and  Pm :  used  to  keep  output  to  ±|  when  medium  negative  or  positive 
errors. 

•  Ns  and  Ps :  used  to  lead  output  to  0  when  small  negative  or  positive  errors. 

•  ZE:  used  to  keep  output  to  0  when  near  to  zero  errors. 

These  fuzzy  sets  have  been  designed  considering  a  fixed  aircraft  velocity  (V*  = 
25 m/s),  figure  6.2  shows  a  contour  plot  of  u*y(e™P,eyP )  membership  functions  at 
fixed  ex. 

These  fuzzy  sets  have  been  designed  considering  a  fixed  aircraft  velocity  (V*  — 
25 m/s),  figure  6.2  shows  a  contour  plot  of  ufy(e)£P,e^P)  membership  functions  at 
fixed  ex. 


6.4  First  FGS  simulation  results 

This  section  shows  some  simulation  results  for  the  first  Fuzzy  Guidance  System.  The 
presented  simulation  shows  a  non  planar  trajectory.  First  the  aircraft  is  driven  to 
waypoint  W\,  then  to  align  with  W2,  then  to  W3  that  is  150  meters  lower  in  altitude 
and  very  near  on  the  (X,  Y)  plane  and  finally  to  W4  that  is  at  altitude  100  with 
a  desired  approach  angle  rotated  by  |  from  previous  waypoint.  Figure  6.5  shows 
this  trajectory.  The  required  descent  from  W2  to  W3  is  too  steep  for  the  aircraft 
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Fuzzy  Zones  {V  «25m/s,  V  =25m/s) 


Figure  6.2:  Contour  plot  of  i/^(e“P,e“P)  membership  functions 

capabilities,  as  decided  in  the  design  phase  of  fuzzy  rule-set.  As  a  matter  of  fact, 
when  the  aircraft  reaches  the  X,  Y  coordinates  of  W3  its  altitude  is  still  too  high, 
and  it  starts  a  turn  to  come  back  to  the  waypoint  at  the  prescribed  altitude.  In  fact, 
the  aircraft  begins  a  spiral  or  8-shape  descent,  centered  on  the  waypoint  vertical  axis, 
decreasing  altitude  with  the  descent  rate  limitation  given  by  FGS,  until  the  waypoint 
altitude  is  reached  and  then  it  proceeds  to  next  waypoint.  In  this  particular  case,  half 
turn  is  enough  to  reach  the  altitude  of  W3,  thus,  when  it  reaches  the  desired  altitude, 
it  holds  it  and  crosses  successfully  waypoint  W3  and,  successively,  waypoint  W4. 

The  above  described  manoeuvre  has  not  been  planned  when  setting  waypoints; 
the  FGS  generates  it  only  because  the  waypoints,  as  a  matter  of  fact,  describe  a  non 
flyable  trajectory  under  the  maximum  accelerations  design  constraints.The  design  of 
fuzzy  sets  requires  a  good  knowledge  of  the  Takagi-Sugeno  fuzzy  systems.  Starting 
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Fuzzy  Zones  {Vw=19m/s,  V*=25m/s) 


Figure  6.3:  Contour  plot  of  u*y(e™P}e™P)  Membership  Functions 


from  desired  flight  performances  fuzzy  sets  should  be  defined  in  accordance  to  the 
aircraft  flight  constraints.  Relationships  between  requirements  and  fuzzy  sets  are  not 
trivial,  thus  a  specific  graphic  tools  has  been  developed  under  Matlab  in  order  to  aid 
the  fuzzy  designer  in  the  most  accurate  analysis  of  the  fuzzy  controller  behavior.The 
proposed  tool  is  capable  to  load  files  from  Matlab  Fuzzy  toolbox  and  allows  to  plot 
the  output  of  the  fuzzy  system  in  different  flight  conditions. 


6.5  Problems  with  the  first  FGS 

The  first  FGS  is  capable  of  achieving  the  first  four  requirements  of  the  guidance 
system  but  it  has  some  limitations: 

1.  loss  of  accuracy  under  some  conditions. 
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Fuzzy  Zones  {V  =38m/s,  V  =25m/s) 


Figure  6.4:  Contour  plot  of  u*y {e^P,eyP)  membership  functions 


Figure  6.5:  Simulation  of  4  waypoints  trajectory 


1000, 


-20  -10  0  10  20  30  40  50  60 

ex[m] 


Figure  6.6:  Example  of  Miss  Distance  Error 

2.  Presence  of  some  singularities  that  raise  incorrect  control  signals 

3.  High  number  of  fuzzy  rules  that  make  behavior  analysis  difficult. 

6.5.1  Accuracy 

There  are  unapcetable  errors  in  the  miss  distance  for  some  initial  state  configurations 
as  shown  in  (fig.6.6)  where  the  miss  distance  is  20  meters. 

The  aircraft  initial  position  is  x  —  50,  y  =  1000  meters,  in  the  waypoint  reference 
system,  with  no  heading  error.  The  problem  arises  because  of  the  rules  set  fpr  the  zone 
XisZE,  lwhose  membership  function  has  an  extension  of  40  meters  with  the  origin  in 
the  middle.  Such  fuzzy  rules  were  designed  assuming  that  the  vehicle  crosses  their 
frontiers  with  a  given  heading,  because  of  provenience  from  neighbor  plane  areas,  that 
is  adjacent  fuzzy  areas.  If  the  heading  angle  value  is  lower  than  the  designed  value, 


104 


the  waypoint  is  not  reached. 


6.5.2  Singularities 

To  explain  the  second  limitation,  consider  two  points  having  the  same  ordinate,  in 
the  waypoint  reference  system,  for  instance:  x\  =  — 500[m]  and  x2  =  500[m]  with 
y  =  1000[m].  Consider  now  the  output  of  controller  FLCx(ex,  ey,  ex)  computed  along 
the  line  connecting  the  two  points  for  an  angle  error  ex  =  ±180°  coinsiding  with  the 
singularity: 

[ex ,  eY]T  =  [xl,  y]T A  +  [x2,  y]T(l  -  A)  ,  A  e  [0, 1] 

The  output  is  shown  in  Figure  (6.7:  from  the  continuity  of  FLC\  there  exists  a  value 
of  ex  for  which  the  system  output  is  in  fact  ±180°.  This  implies  that  an  aircraft 
in  that  position  with  that  heading  continues  its  route  without  turning  toward  the 
waypoint.  As  a  result  of  this  the  system  may  show  limit  cycles. 

6.5.3  Fuzzy  rules 

Redundancy  of  fuzzy  rules  in  the  single  zones  is  another  aspect  that  needs  to  be 
taken  into  account.  For  each  zone,  rule  impose  a  specific  exit  direction.  This  value 
determines  in  the  graph  an  intersection  point  with  the  unit  slope  curve,  where  FLCX 
must  have  negative  slope.  For  instance  in  Figure  (6.5.3)  the  fuzzy  controller  out¬ 
put  is  shown  for  XzsZE  and  YisZE.  The  controller  output  function  determines  the 
appropriate  speed,  necessary  to  reach  the  waypoint  with  the  required  heading. 


6.6  The  second  FGS  structure 

The  limitations  outlined  above  required  a  modification  of  the  overall  controller. 
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Prom  1)  the  central  zone  is  eliminated  and  substituted  by  an  interpolation  of 
zones  X'/.s'N  e  X/.sP. 


•  Since  the  modification  may  introduce  trajectories  possessing  a  limit  cycle  between 
zones  XisN  e  XisP,  the  error  measure  was  modified  so  that  the  singularity  point 
was  avoided. 

•  Prom  3)  and  the  above  modification,  the  number  of  rules  was  decreased. 


Starting  from  the  previous  FGS  scheme,  it  will  be  shown  how  the  new  solution 
changed  the  heading  controller.  In  the  remaining  of  this  document,  the  variables  that 
refer  to  the  waypoint  will  have  a  W  suffix,  those  for  the  vehicle/aircraft  will  have  the 
A  suffix;  later  the  moving  waypoint  or  target  variables  will  have  the  T  suffix. 

The  first  FGS  logic  can  be  summarized  as  follows: 


Vw  +  fv(ev) 

S  7 d=  /7(ejr) 

(  Xd  =  Xw  +  fx(eXc’  eYo’ex) 

where 

/ 

ev  =  V A  Vw 

eH  =  Ha  —  Hw 

\e'xC'eYc\r  =S(Vw,V*)-Rt(Xw)-[Xa-Xw,Ya-Yw]t 
ex  —  Xa  ~  Xw 


with 


(6.23) 


(6.24) 
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Va  —  modulus  of  aircraft  velocity 

Vw  =  modulus  of  desired  crossing  velocity  of  current  waypoint 

Ha  =  aircraft  altitude 

Hw  =  waypoint  altitude 

X a  ,  Y a  aircraft  position  in  the  XY-plane 

Xw,  Y\v  waypoint  position  in  the  XY-plane 

Xa  =  aircraft  heading 

Xw  =  desired  crossing  heading  of  current  waypoint 

The  new  FGS  structure,  for  the  heading  controller,  varies  significantly  .  The  new 

control  logic  is  the  following: 


Vd  =  Vw  +  fv(ev) 

7 d  =  /7(en)  (6-25) 

Xd  —  Xw  +  FLCx(ex ,  V a ) 
where  Xw  e  ex  are  a  new  definition  for  the  crossing  heading  and  the  route  errorres- 
pectively: 

Xw  =  Xw  +  fiXw(exC’eYc)  20) 

ex  —  Xa  ~  Xw 

where  5xw  is  the  fuzzy  controller  that  generates  the  desired  route  heading  in  every 
point  of  XY-plane.  This  computation  is  performed  in  waypoint-fixed  frame  coordin¬ 
ates.  This  new  reference  xw  is  used  by  a  second  fuzzy  controller  to  compute  the  new 
heading  error  ex  to  be  used  as  reference  for  aircraft  heading  autopilot.  The  head¬ 
ing  controller  now  has  a  pipeline  of  two  stages  composed  of  two  fuzzy  systems  much 
simpler  than  the  unique  one  of  the  first  FGS. 

The  resulting  heading  controller  is  depicted  in  figure  6.8. 
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Figure  6.8:  The  second  FGS  Scheme 

6.6.1  First  stage:  desired  route 

Yhe  first  stage  generates  the  heading  value  to  be  reached  within  each  zone  in  the  way- 
point  fixed  reference.  The  design  of  this  stage  depends  directly  from  desired  vehicle 
trajectories  and  must  take  into  account  maximum  aircraft  performance.  Success  in 
designing  the  first  stage  fuzzy  system  results  in  smooth  maneuvers  and  limited  control 
signals. 

To  correctly  approach  the  problem  of  defining  desired  trajectories  in  every  point 
of  the  horizontal  plane,  the  trajectories  are  defined  as  a  convex  interpolation  of  de¬ 
sired  heading  in  a  finite  number  of  partitions  of  the  whole  plane.  The  T-S  fuzzy 
system  succesfully  accomplishes  this  task;  because  of  the  definition  of  position  error 
in  Cartesian  coordinates  and  because  of  the  nature  of  fuzzy  membership  functions, 
the  areas  have  rectangular  bounds. 

To  avoid  the  steep  transitions  in  the  desired  route  especially  in  the  vicinity  of  way- 
point  axis  origin,  which  characterized  the  fist  FGS,  the  problem  has  been  subdivided 
in  two  subproblems:  guidance  in  the  upper  half  plane  ( ey  >  0)  and  in  the  lower  half 
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Figure  6.9:  Desired  routes  in  the  upper  plane  (ey  >  0) 


plane  (ey  <  0). 

The  graphics  of  the  interpolated  desired  routes  in  the  upper  and  lower  planes  are 
shown  in  figures  (6.9)  and  (6.10). 

To  take  into  account  the  singularities  in  heading  representation,  namely  the  fact 
that  heading  measure  has  a  discontinuous  representation  with  a  value  of  ±180°,  the 
output  of  the  two  fuzzy  controllers  must  be  corrected  of  ±360°  depending  on  aircraft 
heading.  The  idea  that  lies  beneath  this  correction  is  to  generate  a  reference  so 
that  an  heading  error  exceeding  ±180°  is  never  achieved.  This  implies  that  \ex\  = 
| xa  ~  Xw |  —  \Xa  —  Xw  —  &Xw |  <  180°.  As  an  example,  consider  the  following: 

Suppose  ex  ~  — 1000, ey  =  1000[m]  with  ex  —  xa  —  Xw  =  —170°  ,  that  is  on  the 
upper  plane  and  away  from  the  waypoint.  The  direction  computed  by  the  first  stage 
is:  Sxw  —  90°  ,  thus  a  counterclockwise  turn  would  be  imposed  to  the  vehicle: 

ex  —  xa  —  Xw  =  Xa  ~  Xw  ~  8xw  =  ex~  $xW  =  —170  —  90  =  —260 

To  avoid  this  problem,  the  5xw  value  is  corrected  by  a  factor  c  =  —360°.  This 


110 


1 1  t  i  i 

pr^ 

iJ/t  I 

1 

t 

1 

1  f 

t  f 

Mill 

\  ^ 

^  /  /  1 

1 

1 

I 

1  1 

t  t 

!  t  t  M 

/  / 

ll\v„ 

\  N 

\  /  /  / 

1 

t 

I 

1  f 

t  t 

lill! 

'  /  j 

1  \  \_ 

\  ^ 

„//  1 

1 

1 

( 

1  1 

1  f 

IMM 

^  /  / 

I  \  \  \  _  * 

\  N 

t 

f 

t 

f 

!  \ 

t  f  . 

Ml!! 

*'  /  / 

\ 

\ 

l^/tt 

f 

1 

f 

1  ! 

t  f 

!  t  1  1  ! 

s 

^/  /  t  t 

f 

1 

1 

1  \ 

I  f 

!  1  t  M 

S  "* 

.//It 

! 

! 

t 

1  ? 

t  f 

Mill 

'  t  ""-v 

^  - 

.//It 

1 

! 

t 

t  ! 

t  t 

.Mil! 

1  t  nuv.. 

.//It 

1 

! 

t 

I  ! 

1  f  . 

!  !  t  M 

MIWns^ 

S  “* 

.//It 

} 

1 

t 

1  ! 

f  t 

!  f  M  ! 

!  1  !  \  \Vs.‘ 

.//It 

f 

1 

t 

!  ! 

!  t 

1  !  t  t  ! 

s  " 

.//It 

f 

1 

1 

I  1 

t  f 

till! 

!  ! 

N  "* 

.//ft 

t 

1 

t 

1  1 

1  t 

. 1..JJL1 

f  i  i  \  v  \.  v ./J 

jlJ/W 

_L 

± 

1 

{  f 

_UL 

Figure  6.10:  Desired  routes  in  the  lower  plane  (ey  <  0) 


approach  is  like  rotating  the  reference  xw  depending  on  the  vehicle  heading  so  that 
the  point  ex  =  ±180°.  The  resulting  |ex|  =  |  —  260  —  ( — 360) |  =  1 100|  <  180  is  inside 
desired  limits. 

In  order  of  mixing  smoothly  the  guidance  in  the  upper  and  lower  plane,  the  cor¬ 
rected  outputs  of  the  two  modules  are  interpolated  with  a  weigthing  function  \xy  that 
depends  on  ey  only: 

t >Xw  =  ^Y{^Y)-{FLCSUp{ex,ey)+csup)  +  {l-^y{ey))-(FLCinf(ex,ey)+Cinf)  (6.27) 

where  cinf  =  ±2kn  e  csup  =  ±2hn  e  k,h  =  ±0,±1,...  Therefore  the  reference 
generated  by  the  first  stage  is: 

Xw  =  Xw  +  Fy(zy)  •  (FLCsup(ex,ey)  +  csup)  +  (1  -  nY(eY))  •  (FLCinf(ex,ey) +cinf) 

(6.28) 

The  first  stage  is  in  fact  composed  of  the  two  fuzzy  controllers  FLCsup  and  FLCinf 
and  their  mixer. 


Ill 
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Figure  6.11:  Function  FLCx(ex,  VA) 

6.6.2  Second  stage:  heading  error 

The  second  stage  generates  the  heading  angle  based  on  the  error  between  the  aircraft 
heading  Xa  and  the  reference  value  generated  by  the  first  stage  xw-  The  objective 
here  is  to  make  ex  =  xa  ~  Xw  €  [-180°,  180°]  equal  to  zero.  The  second  stage  output 
is: 

Xrif  =  Xw  +  FLCx(ex,  VA) 

To  prove  the  correctness  of  this  stage  logic,  suppose  xa  >  Xw,  then  to  decrease 
the  heading  tracking  error,  xA  <  0,  that  is  Xd  <  Xa,  must  hold  because  of  the  linear 
dynamics  expressed  by  equation  (6.10);  then  FLCx(ex,VA )  <  ex.  Otherwise  if  xa  < 
Xw,  Xa>0  must  hold  and  FLCx(ex,  VA)  >  ex.  Then  FLCx{ex,  VA)  6  [-180°,  180°] 
and  the  problem  can  be  solved  as  convex  combination  of  constant  coefficients  in  the 
range  [-180°,  180°]. 

The  dependency  of  FLCx(ex,  VA)  from  the  vehicle’s  velocity,  allows  to  limit  the 
increase  of  radius  of  curvature  as  velocity  increases.  The  behavior  of  FLCx(ex,  VA) 
for  two  different  speed  is  shown  in  Figure  6.11. 
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Figure  6.12:  LD- guidance  geometry 

6.6.3  Long  and  short  Distance  Guidance 

When  the  vehicle  is  away  from  the  waypoint,  a  different  guidance  is  used,  in  order 
to  optimize  the  shape  of  the  trajectories.  This  guidance  is  called  Long  —  Distance 
Guidance  (LD).  The  definition  of  (LD)  guidance  is  set  by  a  distance  from  the  way- 
point,  which  is  a  design  parameter  and  set,  in  our  simulations,  equal  to  a  circle  of 
radius  R  —  2500  [m].  A  blending  law  that  depends  on  the  range  R  computed  as 
\\Raw\\  =  -\J e2x  +  4  selects  either  ID- guidance  or  SD- guidance  : 

Xd  =  Xw  +  Vr(Raw)  ■  FLD(ex,eY,XA,Xw )  +  (1  ~  Vr(Raw))  •  FLD(ex,eY,XA,Xw) 

(6.29) 

ID-guidance  is  defined  using  the  quantities  in  Figure  6.12.  The  guidance  system 
makes  the  aircraft  reach  the  LOS  direction,  zeroing  the  error  5xw  =  Xa~ (Xw  +6los ) • 
The  computation  of  LOS  angle  is  performed  projecting  the  position  error  from 
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5000  r 

Long-Distance  guidance 


Figure  6.13:  Example  of  long-short  distance  mixing 


the  Earth  axes  to  a  reference  at  an  angle  \w  -Therefore  O^os  is  given  by: 

&los  =  atan2(ex,  -eY)  (6.30) 

The  heading  error  entering  the  LD- guidnace  fuzzy  controller  is: 

&Xw  =  Xa  —  ( Xw  —  Qlos)  (6.31) 

and  for  Hr(R)  =  1  we  have: 

Xd  —  Xw  +  @los  +  FLCld(8xa)  (6.32) 

Equation  (6.32)  is  now  in  the  appropriate  form  for  blending  with  SD- guidance. 

The  resulting  FGS  is  depicted  in  Figure  6.14  and  the  complete  control  loop  with 
the  second  FGS  is  depicted  in  Figure  6.6.3. 
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6.7  Management  of  moving  Waypoints 

The  position  error  dynamics  in  the  earth  reference  system,  in  the  case  of  static  way- 
point,  depends  on  the  aircraft  velocity  only: 

[ex,ey]T=^-ZT  (6-33) 

where  XA,  Ya  and  XTy  YT}  are  the  position  of  the  vehicle  and  the  waypoint  along  the 
X  and  Y  axis  of  earth-frame,  Exy  is  the  vector  position  error  and  Exy  is  the  rate  of 
change  of  position  error. 

When  the  waypoint  to  be  reached  is  moving  (a  model  of  a  target,  for  instance), 
the  second  of  (6.33)  no  longer  holds,  and  EXy  depends  on  the  relative  velocity.  The 
tracking  performance 

degrades  rapidly  as  a  function  of  the  waypoint  speed  Vt  and  the  system  cannot 
guarantee  the  waypoint  interception  even  in  easy  cases.  Let  us  consider,  for  instance, 
a  vehicle  aligned  with  the  desired  crossing  direction,  that  is  xa  =  Xw,  and  placed  in 
an  interception  triangle  with  the  waypoint  which  is  moving  in  uniform  linear  motion 
at  a  given  speed  VT,  Figure  6.15  shows  this  situation.  As  a  consequence  of  the 
intercept  condition,  the  vector  VA  —  Vt  results  aligned  with  the  line  of  sight  (LOS). 
The  FGS  is  able  to  maintain  such  condition  only  if  the  position  error  along  waypoint 
frame  X  axis,  is  zero.  In  this  case,  FLCX  (x)  =  0  and  the  vehicle  heading  remains 
equal  to  the  crossing  headingxw*  If  Vt  ^  0,  the  condition  ex  =  0  will  never  be  verified 
with  an  intercept  triangle,  and  proposed  system  does  not  guarantee  interception  with 
a  zeroposition  error. 

By  means  of  appropriate  modifications  to  the  error  measures,  the  proposed  FGS 
will  successfully  achieve  interception  even  in  the  uniform  straight  motion  case.  Let  us 
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Figure  6.15:  Intercept  Conditions  with  moving  Waypoint 


define  PA  (t)  as  the  current  vehicle  position.  Consider  a  virtual  vehicle  with  position 
PA  (t)  such  that  PA  (t0)  =  PA  (t0)  at  instantt0.  Define  the  virtual  vehicle  velocity  as 

vz{t)  =  vA{t)-vz{t) 

The  the  virtual  vehicle  position  at  time  t  is: 


P*A(t)  =  P\  (to)  +  I  VX{r)dT  (6.34) 

to 

that  can  be  written  as: 

t 

P*  (t)  =  PA{t)  -  J  Vt  (t )dr  (6.35) 

to 

Adding  and  substracting  Pj  (to)  to  the  right  hand  side  yields 
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Figure  6.16:  Intercept  Example,  Target  with  uniform  Motion 


PUt)  =  PA(t)  -fVT  (t)At  +  PT  (t0)  -  PT  (t„)  = 

to  (6.36) 

=  Pa{1)  ~  Pr(t)  +  Pt  (to)  =  Exy  +  Pt  (to) 

t 

since  Pr(t)  =  Pt  (to)  +  fVr  (r)dr.Bringing  Pt  (to)  to  the  left  hand  side  yields: 

to 

P*A(t)  -  PT  (to)  =  PA(t)  ~  PT(t )  =  Exy  (6.37) 

Equation  (6.37)  indicates  that  when  the  real  vehicle  reaches  the  target  ( Exy  =  0), 
the  virtual  vehicle  is  in  the  initial  target  position  Pt  (to)-  The  position  error  Exy 
can  also  be  seen  as  the  error  between  the  virtual  vehicle  and  the  initial  target  (way- 
point)  position.  Figure  6.16  shows  the  position  error  vector  during  an  interception. 
Differentiating  equation  (6.37),  and  recalling  that  Pt  (to)  =  0  yields: 

h  (t)  =  VX  =  VA(t)  -  VT(t)  =  Exy  (6.38) 
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that  is  the  rate  of  change  of  position  error  coincides  with  the  virtual  vehicle  velocity 
Pjjj  (t) .  When  the  waypoint  is  moving  in  uniform  straight  motion,  equation  (6.33)  is 
replaced  by: 

I  Exy  =  [XA  -XT,YA-  Yt}t  =  [X%  -  XT(t0), YX  ~  YT(t0)]T  (g  3g) 

\  Exy  =  vx 

The  position  error  in  the  waypoint  coordinate  frame  exy  results: 

exy  =  RT  (xw  +  2)  ’  Exy  (6.40) 

If  xw  is  constant,  then  RT  (xw  +  f )  =  0,  and  the  position  error  dynamics  become 

Exy  =  RT  (xw  +  2)  ‘  Exy  (6-41) 

from  the  second  of  (6.33),  the  position  error  rate  of  change  between  the  real  vehicle 
and  target  depends  on  the  virtual  vehicle  velocity  only: 

txY  —  RT  ( Xw  +  2)  '  (6-42) 

Since  when  the  waypoint  is  fixed  the  virtual  vehicle  coincides  with  the  real  one, 
the  FGS  can  always  produce  the  desired  heading  Xd  for  the  real  aircraft  by  means  of 
the  virtual  vehicle  position  error  respect  to  PT  (f0)and  the  virtual  vehicle  heading  Xa 
computed  from: 

=  z  (VA  -  Vt)  (6.43) 

that  is: 
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Figure  6.17:  Real  and  Virtual  Aircraft,  Intercept  Example 


v;  =  v; 


(6.44) 


cosx^ 
sinx^ 

Figure  6.17  shows  real  and  virtual  aircraft  in  an  intercept  example. 

To  satisfy  the  original  guidance  requirements,  the  following  two  conditions  must 
be  satisfied: 


•  The  module  of  virtual  vehicle’s  velocity  must  be  kept  to  the  value  Vw- 

•  The  value  of  real  vehicle  heading  angle,  when  crossing  the  waypoint,  must  be 
Xa  =  Xw- 


The  first  condition  yields: 


\\VX\\  =  \Va-VX\  =  Vw 


(6.45) 
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Squaring  both  sides  and  replacing  the  expression  of  the  vehicle  and  target  velo¬ 


cities: 


Vw  =  VA  +  VT  -  2VaVt  (cos  Xa  cos  XT  +  sin  xa  sin  xt) 
Looking  for  the  solution  for  which  Va  >  Vt  we  have 


(6.46) 


VA  =  +VT  cos  (Xa  ~  Xt)  +  ^  ^ 

+  VVw  ~  Vt  sin2  (Xa  ~  Xt)  =  Vd  (xa) 

The  second  condition  is  satisfied  with  the  introduction  of  a  different  desired  heading 
angle  at  the  waypoint.  When  the  real  vehicle  reaches  the  waypoint  with  the  correct 
velocity  Va  =  Vd  (xa)  and  the  correct  heading  angle  Xa  =  Xw,  then  the  virtual  vehicle 


velocity  is: 


V2  -  Vd  (xw) 


cos  Xa 

sin  Xa 


cosxa 
sin  Xa 


(6.48) 


>From  (??)  and  (6.48),  the  virtual  vehicle  heading  angle,  when  crossing  the  initial 
waypoint /target  position  Pt  (to)  is: 


Xw  ~  V-\  Vd(xw) 


cos 
sin  Xa 


cos  Xa 
sin  Xa 


(6.49) 


It  can  be  shown  that  Xw  =  Xw  when  VT  =  0.  Therefore  the  desired  heading 
angle  for  the  virtual  vehicle  Xw  depends  from  the  target  velocity  Vt]  thus  the  error 
position  in  the  waypoint  frame  is: 


SXY  =  R  [x*w  +  2  )  '  Exy 


(6.50) 
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If  the  waypoint  is  moving  in  uniform  straight  motion,  under  the  condition  xw  =  0, 
then  x_w  =  0  and  : 

i’xY  =  RT  (xw  +  f  )  •  Bxy  =  Rt  (xw  +  § )  '  VX  (6.51) 

The  above  results  require  modifications  on  both  LD-guidance  and  SD-guidance.  In 
SD-guidance  the  velocity  (V^),  and  flight  path  angle  (/yd)  references  for  the  autopilots 
are  generated  according  to  the  following: 

’v<=tW  +  /vW  ,ar„ 

<  (6.52) 

k  7 d  =  /hM 

where  ev  =  Va~  (xa)  is  the  error  between  the  real  vehicle  velocity  and  the  desired 
velocity  given  in  (6.47). 

For  the  heading  reference  (xd)-  The  first  stage  geneates  the  desired  heading  for 
the  virtual  vehicle 


Xw  ~  Xw  +  &xw  (WexC’WeYc)  (6.53) 

where  (We*xc,WeYc)  are  the  velocity-compensated  position  errors  along  the  waypoint 
frame  X  and  Y  axes: 


=  S  (Vw)  ■  e*xY  = 

—  S  (Vw)  ■  RT  (xw  +  f )  ■  ExY 

The  desired  heading  for  the  real  aircraft  ,  with  6a  =  Xa  ~  Xa- 

Xw  =  Xw  4"  £a 

The  reference  heading  Xd  for  the  autopilot  becomes: 


(6.54) 


(6.55) 
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Xd  =  Xw  +  F LCXw  ( ex ,  VA) 


(6.56) 


%c  =  XA  ~Tw 

The  LD-guidance  has  a  different  generation  of  desidered  heading,  equation  (6.53) 
is  replaced  by: 


&  =  Xw  +  6’los  +  FLCld  (4l)  (6  ”) 

with  0*LOS  =  a  tan  2  (we*Xc,wepc)  LOS  angle  with  respect  to  Xw>  and  $x*A  =  X*a  ~ 
(Xw  +  Q*los)-  Equations  (6.55),  and  (6.56)  still  hold. 

6.7.1  Simulation  Results 

This  section  contains  some  simulation  results  with  moving  waypoints,  results  for  fixed 
waypoints  can  be  found  in  the  interim  report.  In  all  simulations  the  target  velocity 
is  lOm/s,  and  the  desired  crossing  relative  velocity  is  30m/s.  The  target  is  always 
reached  within  a  good  approximation  in  heading  and  intercepts  distance.  Figures 
6.18  and  6.19  show  two  different  simulation  scenarios. 

Figure  6.20  shows  the  case  of  two  consecutive  interceptions  of  a  moving  target. 
The  application  of  the  proposed  guidance  to  the  case  of  targets  moving  with 
constant  angular  velocity  is  shown  in  the  next  two  figures.  In  Figure  6.21  intercept  is 
achieved,  whereas  in  Figure  6.22  the  miss  distance  is  different  from  zero.  This  latter 
result  may  be  satisfactory  depending  on  the  tolerance  required. 

Figure  19: 


123 


124 


X|m| 


Figure  6.20:  Two-Target  Interceptions  (Target  in  red) 


125 


Figure  6.21:  Target  with  nonzero  Angular  Velocity 
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Figure  6.22:  Intercept  Scenario:  Targets  with  an  angular  velocity  equal  to  xt  = 
2  [deg /sec]. 

The  las  simulation  shows  the  capability  of  the  system  to  handle  multiple  vehicles 
and  multiple  targets. 
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